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FOREWORD 


The investigation described in this report was performed by Information 
& Control Systems, Incorporated (ICS) under Contract Number NAS1-15759 for 
the National Aeronautics and Space Administration, Langley Research Center, 
Hampton, Virginia. This work was sponsored by the Applied Controls Branch of 
the Flight Control Systems Division. Mr. Richard M. Hueschen served as 
Technical Representative monitoring this contract. Use of trade names or 
names of manufacturers in this report does not constitute an official endorse- 
ment of such products or manufacturers, either expressed or implied, by the 
National Aeronautics and Space Administration. 



ABSTRACT 


This report contains the development of a digital outer-loop three 
dimensional radio navigation (3-D RNAV) flight control system for a small 
commercial jet transport. The outer-loop control system is designed using 
optimal stochastic limited state feedback techniques. Options investigated 
using the optimal limited state feedback approach include integrated versus 
hierarchical control loop designs, 20 samples per second versus 5 samples 
per second outer-loop operation and alternative Type 1 integration command 
errors. Command generator tracking techniques used in the digital control 
design enable the jet transport to automatically track arbitrary curved flight 
paths generated by waypoints. The performance of the design is demonstrated 
using detailed nonlinear aircraft simulations in the terminal area, frequency 
domain multi-input sigma plots, frequency domain single-input Bode plots and 
closed-loop poles. The response of the system to a severe wind shear during 
a landing approach is also presented. 
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I. INTRODUCTION 


To meet the higher volume aviation requirements projected for the 1980 - 
1990 period, NASA is conducting research and development under the Advanced 
Transport Operating Systems (ATOPS) Program at the Langley Research Center. 

The major effects of higher volume will be felt in terminal area operations. 
The goals of the ATOPS program include increased efficiency in the utilization 
of an airport’s terminal area airspace, optimization of aircraft and airport 
operations, and safe take-off and landing in most types of weather conditions. 

An important step in the achievement of these goals is the development 
of technology and system design procedures which provide the ability to fly 
specified curved paths with high accuracy during the radio naviation (RNAV) 
and Microwave Landing System (MLS) phases of the flight. In an effort to 
achieve the ATOPS goals, Ref. 1, has developed an advanced digital flight 
control system synthesis procedure using the concept of optimal stochastic 
limited state feedback. This report is the application of the synthesis 
procedure in Ref. 1, to the design of an outer-loop digital flight control 
system for the ATOPS research aircraft. The digital control system is 
designed to process guidance information from external sources and aircraft 
aerodynamic and kinetic information from onboard aircraft sensors in order 
to command control effectors so that the aircraft flies arbitrary curved 
paths. The three-dimensional curved paths are generated by waypoints 
supplied by the pilot or a flight schedule. The commerical jet follows the 
path and a specified calibrated airspeed profile without regard to positional 
timing errors along the path. The advanced autopilot described in this 
report is viewed as a three-dimensional radio navigation (3-D RNAV) outer- 
loop digital flight control system. The airspeed proflie could be selected 
so as to achieve some 4-D objectives, however, without much difficulty. 

The block diagram in Fig. lb is a simplified depiction of the way the 
control system in this report should be implemented. The digital control 
system is composed of an inner-loop operating at 20 samples per second and 
an outer-loop control system operating at either 20 sps or 5 sps. The inner- 
loop control system feeds back accelerometer and rate gyro signals in order 
to stabilize the aircraft’s "fast" dynamics such as the short period, Dutch 
roll and roll modes, (Ref. 2). The inner-loop system used here was previously 
designed using classical control design techniques, and is taken as is in 
this study. The outer-loop control system processes information about the 
aircraft’s slower responding dynamics, such as vehicle attitude and geograph- 
ical position, to perform a variety of functions. Examples of outer-loop 
control functions include flight path angle select, pitch attitude control 
wheel steering, altitude select, horizontal path tracking, heading select 
and the 3-D curved path tracking autopilot designed in this report. The 
inner- loop, outer-loop terminology used in Fig. 1 is often employed in what 
is historically referred to as "classical 11 control structure synthesis 
methodology. 

NASA has previously researched and flight tested a three-dimensional 
area naviation (3-D RNAV) path tracking control system described in Ref. 3. 

The control design discussed in Ref. 3 is arrived at primarily using the 



classical control synthesis methodology previously mentioned. The classical 
control system has a structured Laplace transform (s-domain) block diagram 
configuration. Control modules such as gain elements, wash-out filters, low- 
pass filters, complementary filters, integrators and signal limiting opera- 
tions are used throughout the block diagrams. The control loops operate in 
a decentralized manner (no roll angle feedback to rudder except during decrab 
no pitch attitude feedback to throttle, etc., ...). The inner-loop and outer 
loop control designs discussed in Ref. 3 are implemented digitally using the 
Tustin transform. 

The control design presented in this report uses the modern control 
approach. The outer- loop control design is synthesized directly in the 
discrete-time domain by minimizing a quadratic performance index defined by 
a weighted sum of mean-square steady state responses and controls. The inner 
loop control system used with the outer-loop design consists of the primary 
feedback paths of the inner-loop design discussed in Ref. 3. 

The inner-loop control system discussed in Ref. 3 has a simple block 
diagram structure and is straightforward to implement. The inner-loop con- 
trol system has been extensively analyzed and successfully flight tested. 

Some inner-loop control elements are eliminated when the inner-loop control 
system is modeled and combined with the aircraft model in order to perform 
the outer-loop control system design in this report. The integrity and 
stability characteristics of the reduced inner-loop control system are re- 
tained, however. Imposing a predefined control structure that is not to be 
altered in the modern control approach, is a problem that is both practical 
to solve and is a better representation of control design philosophy prac- 
ticed in industry. 

The modern control state-space methodology is often synonymous with 
the full state feedback Linear Quadratic Gaussian (LQG) approach to control 
design. A quadratic performance index is minimized to yield feedback paths 
from all states to all controls. Unmeasured or unavailable states are 
estimated using a full order Kalman filter that should vary with flight 
condition. The use of the full state feedback LQG method for the outer-loop 
design would cause the inner-loop control design to be altered. The meaning 
of inner-loop/outer-loop would be vague if the full state feedback LQG ap- 
proach were to be used for the 3-D RNAV control problem. 

In order to design the outer-loop control system, a departure is made 
from the full state feedback LQG approach. The quadratic cost function is 
minimized using a control system restricted to use limited state feedback. 
Reference 1, presents the theoretical development of the optimal stochastic 
limited state feedback approach. Reference 1 also formulates and proves the 
convergence of a new numerical algorithm which determines an optimal limited 
state feedback gain. Sufficient conditions for the existance of the gain are 
also presented. The advantages of using optimal limited state feedback in 
the outer-loop control system are as follows: 

• Only chosen states are used for feedback purposes. The inner- 
loop control system remains unaltered as desired. 
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• Estimates of all states are not required. A time-varying 
Kalman filter with its associated complexity and real-time 
implementation requirements is not used. 

• Low-order filters such as analog prefilters and digital 
complementary filters can be included in the aircraft design 
model and their effect on control performance is accommodated 
when the control gains are computed. 

• Actuator dynamics and gust dynamics can be included in the 
aircraft design model, their effect on control performance 
is taken into account when the quadratic cost is minimized, 
but their states are not fed back and hence do not have to 
be measured or estimated. 

• There is no separation of stochastic performance and closed- 
loop performance for optimal limited state feedback even 
though all noise sources are assumed to be white Gaussian 
noise. Increasing the measurement noise on some feedback 
variables causes the corresponding feedback gains to be re- 
duced when the quadratic cost function is minimized. 

• There is an increased flexibility in choosing a control 
structure when using optimal output feedback. Each control 
loop can be designed individually in a hierarchical approach 
using different measurements for each loop closure. L0N1, an 
outer-loop longitudinal control system which is discussed later, 
is designed using the hierarchical approach. 

• The control law can also be designed in an integrated manner, 
i.e. , the various controls work in cooperation to achieve 
the desired maneuvers. All other outer-loop control systems 
designed in this report are formulated using the integrated 
approach. 

• The new numerical algorithm discussed in Ref. 1 can be applied 
to relatively large order plant models without difficulty. 

The largest plant model used in this report has 18 states. 

• The propor tional- integral- f ilter (PIF) control structure can 
be used in the outer-loop design. 

The PIF structure in incremental form has been successfully flight tested 
as discussed in Refs. 4 and 5. DIALS in Ref. 6 was successfully flight tested 
using a PIF-like structure in position form. The PIF structure accommodates 
computation delay, has good high-frequency roll-off characteristics, uses 
integral control and allows command generator tracking theory. Refs. 7 and 8, 
to be used. The theoretical derivation of the optimal output feedback PIF 
control system used in this report has not appeared elsewhere. 
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The outer- loop control system discussed in this report may be flight 
tested using the ATOPS B-737 aircraft, a small commerical jet transport. 
Control of the aircraft is provided by commands to the elevator, ailerons, 
rudder, throttle, spoilers, stabilators and flaps. Based on experience 
gained during the flight tests of autopilots discussed in Ref. 4, more than 
one outer- loop control system design is presented for both the longitudinal 
and lateral dynamics. The primary difference between the designs are the 
gain elements and the way the command errors are constructed. The control 
structure remains the same. Multiple designs increase the probability of 
success and allow for inflight comparisons between gain sets as an indica- 
tion of the direction of improved pilot acceptance. 

A. ORGANIZATION OF THE REPORT 


The state-space control system design model is discussed in Chapter II. 
Linear continuous-time models are presented for individual subsystems. The 
subsystem models are combined into a large order design model representation. 
The procedure for representing the design model in discrete-time is summa- 
rized. The inner-loop control system operates at 20 samples per second (sps) . 
Outer-loop designs are performed for 20 sps and 5 sps. In the later case, 
the digital control system is implemented multirate, although only single- 
rate synthesis techniques are used in this report. 

Chapter III begins with a short summary of the optimal output feedback 
problem and the solution presented in Ref. 1. The outer-loop PIF control 
system causes the aircraft to follow a curved path in the terminal area. 

Chapter III discusses how this is accomplished. A waypoint path construc- 
tion procedure, derived and investigated in Ref. 9, generates a smooth 
path using specified waypoints and a spherical earth assumption. A command 
model is constructed, as in Ref. 4, which can generate the important attri- 
butes of the path, i.e. , height profile, roll profile and airspeed profile. 

The command model follows the path; the outer-loop control system forces 
the aircraft to follow the command model. 

The control designs and time-domain evaluation are presented in Chapter 
IV. The gains are designed at eight flight conditions. The gains are sched- 
uled using calibrated airspeed (CAS) as the independent variable. The sched- 
uled gain designs are simulated and evaluated using a full nonlinear six-degree 
of freedom (6-DOF) simulation. 

A frequency domain evaluation of the outer-loop PIF control system designs 
are presented in Chapter V. Sigma plots, Ref. 10, and Bode plots are graph- 
ically portrayed and discussed. Chapter VI shows the performance of the con- 
trol system, inner-loop and outer-loop, along a curved descending trajectory 
in the terminal area. Chapter VII summarizes the report and suggest areas 
where further developments could improve optimal digital implementable con- 
trol systems. The product of the control design effort is software subrou- 
tines that can be programmed onboard the flight computer. Appendices A and B 
present the FORTRAN control subroutines used in the nonlinear simulation. 
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II. PLANT MODEL 


The application of the linear optimal stochastic output feedback control 
synthesis procedure to outer-loop control design requires mathematical models 
for the aircraft, wind disturbances, actuator dynamics, outer-loop filters 
and inner-loop control system dynamics. This chapter provides a summary of 
the models and the state variable definitions. Further documentation of the 
actuator dynamics and inner-loop dynamics are provided in Refs. 11 and 12. 

A. AIRCRAFT OPEN-LOOP DYNAMICS 


The nonlinear equations of motion of the aircraft are determined by con- 
structing kinematic relationships between aircraft translation and angular 
position states and by applying Newton 1 s Second Law to the dynamics of the 
vehicle. A body-fixed axis system is used in this report. The origin is 
located at the body center of mass, and is fixed in orientation with respect 
to the vehicle. The body x-axis extends forward out the vehicle 1 s nose, 
the y-axis extends out the right wind, and the z-axis extends out the bottom 
of the vehicle. 

The aircraft dynamics fall into the general state equation 
x = f_(x, u) (1) 


by noting that aerodynamic forces and moments are functions of aircraft 
states, x, controls, u_, and to some extent the state history. A linear 
time-invariant model representation is required to perform the control 
design. The model is determined by modeling small changes in aircraft 
motion due to small changes in control position. 

The linearization procedure is performed by the construction of a Taylor 
series expansion representing the nonlinear equations about some nominal 
trajectory: 


x = Xq + Ax + Higher Order Terms 


( 2 ) 


v , 3f 

= KXq, Uq) + - 

ox 




Ax + ^ 

9u 


All + Higher Order Terms 


(3) 


£=*o 
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Here, the subscript "0" indicates the nominal value and the prefix M A M 
denotes a small perturbation. All except first-order terms are then 
neglected by arguing that the higher-order terms are small compared to 
linear terms. The results of this procedure are separated into a nonlinear 
equation describing the nominal trajectory and a linear equation defining 
ther perturbation motion dynamics, 


*0 = V 


(4) 


Ax = AAx + BAu 


(5) 


The linear model is further separated by noting that the lateral- 
directional dynamics and the longitudinal dynamics tend to decouple for 
straight and level flight. The states in Ax for the lateral-directional 
dynamics are ordered Av, Ar, Ap, Ac f), A£ and Ac. The states are, respec- 
tively, y-axis velocity, yaw rate, roll rate, roll angle, track angle error 
and cross track error. The states in Ax for the longitudinal dynamics are 
ordered Au, Aw, Aq, A0, Az and are, respectively, x-axis velocity, z-axis 
velocity, pitch rate, pitch angle and z-axis position. The control system 
is to operate as a three dimensional path tracking system (i.e., Ac, ACAS 
and Ah are to be regulated to zero) hence, longitudinal horizontal path 
error, Ax, is not included in the model and is not regulated to zero by the 
control system. The state, Ah, is the vertical height from the earth’s 
surface to the aircraft’s eg. For small pitch angles, Az and Ah are essen- 
tially equal in magnitude. 

Eight linear aircraft models are used to design the control system. 

The aircraft is trimmed for straight and level flight at 1524 m (5,000 ft) 
and 8,500 lb. The eight different CAS values used are 62 m/s (120 kt), 

69 m/s (135 kt) , 77 m/s (150 kt) , 85 m/s (165 kt), 93 m/s (180 kt) , 124 
m/s (240 kt) , 139 m/s (270 kt), 154 m/s (300 kt) . Flaps are positioned 
as a function of CAS for each flight condition as shown in Appendix B. 

B. GUST MODEL 


The predominate random disturbance affecting the aircraft dynamics is 
wind gusts. The wind gusts can be modeled using the well-known Dryden spec- 
trum. The modeling effort consists of using spectral factorization methods 
to obtain a dynamical system which generates a random process having the 
specified power spectral density when driven by a white noise process. The 
gusts affect the body- axis aircraft velocites. Rotational gusts around the 
aircraft are ignored. The transfer functions for the gust dynamics are as 
follows : 
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(7) 


( 8 ) 


In the gust models, is the true airspeed, L u , L v , and are the 

scales of turbulence, and O u , (J v , and a w are the variance of the gust. The 
scales and gust variances are shown in Table 1. 

A state-space realization of Eqs. 6 to 8 is 




LAWgJ 


Aw 

w — g 


w = A Aw + B Aw 
— w — g w — 


(9) 


( 10 ) 


Where 


Aw T = [Ar| An An ] (11) 

” U V W 

Aw is a vector of independent Gaussian white noise process with unit vari- 
ance. Combining Eq. 10 and Eq . 5 yields the aircraft model 


Ax = AAx + BAu + EAw 


( 12 ) 


As new states are added to the design model representation, the vector Ax 
and matrices A, B and E are increased appropriately in dimension. It should 
be, clear however, that A in Eq. 5, Eq. 12 and Eq. 32 are of course, not equal. 

C. ACTUATOR DYNAMICS 


Block diagrams for each actuator and a short description of the block 
diagrams are presented in Ref. 11. Only the linear perturbation dynamics 
are presented in this section. 
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In the aileron actuator system, a lead/lag filter processes the aileron 
position command to provide phase advance. The output of the lead/lag filter 
drives the aileron hydraulic value. The rate limited valve position drives 
the cable system that rotates the aileron surface. Cable stretch caused by 
increased dynamic pressure is modeled as a gain reduction of the value commanded 
to the aileron surface. Cable hysteresis (^0.2 deg aileron) is modeled in the 
nonlinear simulation. If the aileron command from the valve exceeds ~2.5 deg, 
then spoilers are also deflected. 

Raising left or right spoilers reduces the lift on the left or right wing 
resulting in a lift differential and rolling moment which serves to boost the 
roll power. Decreasing the lift on a wing affects the longitudinal dynamics. 

If spoilers are deflected beyond ~3.5 deg, then a spoiler feedback loop is 
closed to produce a gain which decreases the original aileron command. The 
gain which reduces the aileron command is also a function of flap position. 

The spoiler feedback and the lead/lag filter are used to eliminate a 
limit cycle problem that occurs when roll attitude is regulated through the 
aileron actuator system for the outer-loop control system discussed in Ref. 

3. The spoiler feedback and lead/lag filter is also used in the outer-loop 
control design in this report. 

A linear model of the aileron/spoiler system is as follows: 


“a] . r - 12 - 38 -1.021k! (VVWlp.l 

AS J L202.6 -20.0 JLaS J 

s s 

+ [1-021 + °* 510k i(Vl AS 

0.0 J AC 


X ' 


11.0 

0 " 


1.0+0.0015q 


“SPL 

= 

0 

0 

_ A(5 spr_ 


0 

1.0 



(13) 


(14) 


The model ignores hysteresis, rate limits, position limits, and residualizes 
and eliminates the lead/lag filter pole. The function kp(6p) represents the 
effect of nominal flap position. The function ^(dcjpp) represents the gain 
of the spoiler feedback loop as a function of spoiler position and q is 
dynamic pressure. Only the right spoiler is used for design purposes but 
it is assumed to have positive and negative values. 

The rudder dynamics are straight forward and are modeled simply as 


A6 = -32.68 A6 4- 2.438 A6„ 0 
r r RC 


( 15 ) 
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( 16 ) 


A6 n = 13.4 A6 
R r 

The model ignores rate limits and position limits. 

Throttle position commands engine thrust. Throttle position, which 
is limited to 0 - 60 deg, commands EPR (engine pressure ratio). The EPR 
command is subjected to upper and lower rate limits that vary as a function 
of EPR and the direction EPR is moving in. A table of look up functions 
is used to compute engine thrust from the value of EPR, i.e. , = f (EPR) . 

The model for throttle becomes, 


AEPR = - y AEPR + f AS (17) 

4 C it. 

AS t = bAEPR (18) 


The value of a is the steady state relationship between throttle position 
and the EPR command for the nominal flight conditions. The value for C is 
chosen so that the resulting throttle control system design behaves well 
in nonlinear simulations. The £ value was varied from 0.2 to 2.0 seconds, 
with the later value becoming the one used in the outer-loop design model. 
The parameter, b, is the perturbation linear relationship between EPR and 
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T* 


The linear model for elevator is straightforward 


and given by, 


A6 = -23.23 A6 + 2.0779 A6^ 
e e EC 


(19) 


A6 


E 


10.76 

1.0 + 0.0023 q 


A6 

e 


( 20 ) 


The model includes the effect of cable stretch. The position of elevator 
drives the stabilator. If elevator moves above a certain computed value 
and remains there for a length of time, (1.2 sec), the stabilator moves in 
a direction which causes elevator trim to return to a neutral position. 
Stabilator moves at a constant rate of ± 0.03 deg/sec or ± 0.18 deg/sec 
depending on the flap position. Stabilator serves as a trimming device and 
a linear model is not necessary for analysis and design. Flaps are simi- 
larly used for trimming purposes at low speeds (see Appendix B) and a linear 
model is not necessary for analysis and design. 

D. INNER-LOOP CONTROL SYSTEM 


The inner-loop control system block diagrams, reported in a preliminary 
version in Ref. 12, are shown in Figs. 2 to 5. After an analysis of the 


q 



inner-loop designs and their interaction with modern control outer-loop 
structures, a number of deletions were made to arrive at a desirable inner- 
loop system. 

All of the control loops in the autothrottle block diagram shown in 
Fig. 4 were eliminated. The an< 3 ^GS feedback loop at lower left in 

Fig. 4 is a wind shear detection system used to advance or retard throttle 
in wind shears. The EPR protection system in the upper part of the figure 
is used to keep EPR below the maximum value MXEPR - 0.10. The haversin 
washout roll function in the upper left part of the figure is used to 
advance throttle during turn initiation. 

The output feedback outer- loop counter part to the EPR protection 
system is the upper limit placed on the throttle command as a function of 
EPR as shown in Appendix B. The response of the output feedback outer- 
loop control system to wind shear is shown in Section IV F. The simu- 
lations indicate that the integrated approach to autothrottle design, 
whereby all feedback loops (such as height error, pitch attitude error, 
height integral error, etc.) are feedback to throttle, causes autothrottle 
to react appropriately during severe atmospheric conditions. The roll 
crossfeed to throttle in Fig. 4 is not used and airspeed loss in a turn 
is not particularly noticeable. 

All inner-loop elements for the elevator control system in Fig. 5 
are retained except for the integrator feedback through the k24 gain. The 
outer-loop control system uses integral feedback directly on the outer-loop 
tracking errors. Washed-out pitch rate and vertical acceleration feedback 
in the inner-loop damp the short period mode. Roll squared feedback im- 
proves vertical height tracking in turns. The outer-loop control system 
uses individual gain scheduling as a function of CAS as well as retaining 
the inner- loop gain schedule shown in Fig. 5. 

Roll rate feedback and the gain schedule shown in Fig. 2 are also 
retained in the aileron/spoiler inner-loop control system. Roll rate feed- 
back damps the roll mode response of the aircraft. The roll angle tracking 
loop in Fig. 2 is deleted from the inner-loop control system. Roll angle 
tracking error is used directly in the outer-loop integral feedback expres- 
sion. The yaw damper inner- loop control system for rudder is shown in Fig. 
3. The washed-out yaw rate signal has authority to ± 4 deg and serves to 
damp the Dutch roll mode. The yaw damper is retained in the inner-loop 
control system. 

Linear continuous-time models for the inner-loop control systems can 
be directly inferred from the block diagrams as follows: 

Throttle: 


A6 


TC 



( 21 ) 
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Elevator: 


AS EC K CAS ^'27 k 25* k 22' 


+ K CAS A “e 




+ K CAS ^ k 27 


0.0] I" Aq + Av^ "1 

[_Aa, + Av I 
h a h 


( 22 ) 


> 

r 
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i 

<1 

L 


■1.0/k 2g 0.0 


L 0.0 -1.0/k 20 JLAa. 


'Aq 


WO 


(23) 


-1.0/k 2g 0.0 


L o.o -i.o/k. 


20 J L h 


Aq + Av 


Aa, + Av J 


Aileron/ Spoiler: 


A^ac “ ^ -k v* k 33^ + k -- ^ u - 


v a 


(24) 


Ap = [-1.0/k 32 ] Ap + [1.0/k„] [Ap + AvJ 


32 


(25) 


Rudder : 


A6r C = [1.0 1.0] 


Ar wo 

.Ar J 


+ [Au r ] 


(26) 


A y wo 


'-1.0/k 42 

-i.o/k 42 ‘ 


Ar wo 

+ 

0 

/S 

Ar 


0.0 

-1.0/k 4] 


Ar 


_™>*W k 41_ 


(Ar + Av ) (27) 
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Combining the inner-loop control system subsystems yields 


A %L ■ A IL + B IL A iMEAS 


( 28 ) 


The inner-loop discrete-time representation used in Appendix B is determined 
using Eqs. 39, 40 and 41 in conjunction with Eq. 28. 

E. OUTER-LOOP COMPLEMENTARY FILTERS 


Outer-loop filters are used to suppress sensor measurement noise and 
can be included in the control system design model using the limited state 
feedback approach. Flight tests results in Ref. 4 indicate that the vertical 
height complementary filter has a significant effect on closed-loop stability 
of the longitudinal control system. The complementary filter combines a 
vertical height position measurement with onboard body-axis accelerometer 
measurements to provide a smooth estimate of vertical position and vertical 
velocity. A discussion of the filter structure and design is given in Refs. 4 
and 5. The discrete-time version of the third-order complementary filter 
used in the longitudinal outer-loop control system is 


Update : 


’h(+)~ 


"h(-)‘ 


"0.004 


h(+) 

= 

• 

A 

h(-) 

+ 

0.016 

[^MEAS ^k] 

_b(+) _ 

k 

A 

_b(-)_ 

k 

-0.000475_ 

k 


Propagate: 


/s “ 

h(-) 


1 At 0 

h(+) 


At/2 

h(-) 

= 

0 10 

fi(+) 

+ 

At 

U(-). 

k+1 

.0 0 1 . 

. b (+)_ 

k 

. 0 _ 



V + >' 


(29) 
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The digital filter operates at 20 iterations per second. The state, 
b, is an estimate of accelerometer bias. The local-level accelerometer 
measurement is corrected for gravity to obtain a^. 

Similiar filters are used to compute the horizontal x and y position 
of the aircraft. Flight tests in Ref. 6 indicate that including the comple- 
mentary filter for y in the lateral dynamic model is not necessary. The 
position complementary filter is not included in the lateral model for the 
outer-loop control design. 

The accelerometer bias estimator dynamics have little effect on the 
outer-loop control system. The bias state is neglected when the digital 
filter is expressed in analog form for inclusion in the outer- loop 
continuous- time design model. The analog form is 


- h~ 


" -0 . 8 

1.01 


‘ h ' 


-0.8 - 


-0.0” 

Li. 


--.32 

0.0- 


A 

Lh J 

+ 

-0.32- 

h + 
m 

-1.0 • 


(31) 


F. DISCRETE REPRESENTATION 


Combining the linear models for the aircraft, actuators, gusts, 
outer- loop filters and inner-loop control system yields the outer- loop 
control system design model, 


Ax = AAx + BAu + EAw 

The states in the longitudinal and lateral-directional design models are 
Longitudinal: 

rjt A A A 

Ax = [Au Aw A0 Aq Az A6 AEPR Aq Aa, Ah Ah u w . w _] 

- e M W0 “h g gl g2 J 

Au T = [Au Au ] 

- e t 

T 

Aw = [Av Av At) Ar, ] 

- q a h 'u 'w 


(32) 


(33) 

(34) 

(35) 
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Lateral-Directional: 


Ax T = [Av Ap Ar A<j> A£ Ac A6 & A6 g AS^ Ap Ar WQ Ar v ^ v^] 

Au^ = [Au Au ] 

— a r 

T 

Aw = [Av Av An ] 

— p r v 


(36) 

(37) 

(38) 


The method used to represent the plant for direct digital design of 
the outer-loop control system is to assume the control, Aju, is constant 
over the sampling interval, At; resulting in the plant representation; 


A ^k+l - + FA Sk + V^k 


(39) 


The matrices in Eq. 39 are obtained from 


. AAt 

<P = e 


(40) 

II 

rt 

e^ S ds B 

(41) 

r Aw, = j 

w — k J 

e^ S Ew(s)ds 

(42) 


It is not necessary to know T w and Aw^ in Eq. 39. Only the mean and 
covariance of the Gaussian white noise vector, T w Awk, are required for 
design. 

Equation 39 is an exact discrete representation of the plant if the 
inner-loop control system and outer-loop filter are implemented as analog 
networks. The inner-loop control system and outer-loop filter are imple- 
mented digitally, hence, Eq. 39 is not an exact representation of the plant 
dynamics. If the outer-loop control system is designed at a slow rate (5 
sps is used in Chapter V) and the inner-loop control system and outer-loop 
filter were modeled correctly, the control synthesis model would become multi- 
rate. Techniques for handling optimal, multirate, multivariable control 
synthesis have been determined in Ref. 13, but are outside the scope of this 
work. The single-rate plant model representation in Eq. 39 proved to be ade- 
quate for outer-loop control synthesis for either 20 sps or 5 sps outer-loop 
operation. 
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In Ref. 12, step response comparisons are made between Eq. 39, a linear 
time-invariant model, and a nonlinear simulation of the commerical jet trans- 
port dynamics with the correct discrete implementation of the inner-loop 
control systems. A summary of the comparisons follows: 

Elevator: Good match in both actuator and inner-lo'op dynamics. 

Rudder : Good match in both actuator and inner-loop dynamics. 

Aileron/ 

Spoiler : Adequate match which deteriorates as the control input 

step size increases. Highly nonlinear behavior of the 
aileron/spoiler actuators and vehicle aerodynamics is 
the likely cause of the problem. 

Throttle: Poor match due to the highly nonlinear behavior of the 

engine dynamics. 
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III. DIGITAL FLIGHT CONTROL SYSTEM 


This chapter presents a brief derivation of the linear part of the 
digital flight control system. The derivation is accomplished by formu- 
lating a tracking problem embedded in a limited state feedback, sampled- 
data regulator problem; then converting the limited state feedback/feed- 
forward optimal solution to a final implementable structure. A full 
state feedback derivation of the outer-loop control structure used in 
this report is presented in Ref. 4. The modifications needed for limited 
state feedback are shown in the following sections. 

A. OUTER-LOOP TRACKING 


The tracking problem is formulated in Chapter I as a model following 
problem. The control law must cause the output of the linear aircraft model 


- HAx r + DA„ k 


(43) 


to optimally track the output of a linearized command model 


Ax i .i = $ Ax , + r Au , , - 
~“tn,k+l m — m, k m — m,k+l 




= H Ax , + D Au , , - 
m — m,k m ^m,k+l 


(44) 

(45) 


at the equally spaced sample times t^.. The number of commands in Eq. 45 
is assumed to be equal to the number of aircraft controls used for tracking 
purposes . 

The command model input, Aii m , is assumed to be constant previous to tj c =0, 
changes at t^O, then remains constant thereafter. The assumption results 

in excellent control system performance in implementation when Au m is allowed 
to vary slowly or intermittently. Each change in A^ is viewed as a new 
initial condition. 

When Ay^ equals Ay^ ^ , the plant states and controls follow a trajectory, 
Ax^ and Ajj£ which satisfy the equation, (Refs. 7, 4 and 8). 


Ax* 

— k 







L A 21 


22J 


Au 
— m 


(46) 
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The feedforward matrices, A± j , satisfy the solvable matrix algebraic equation 


M 

4. 

1 

r l 

r A n 

A 12 "1 

-A. (4-1) 
11 m 

A 11 r m] 

Lh 

D J 

A 21 

A 22 

H 

m 

D J 

m 


The algebraic equation has a solution when the plant. has no transmission 
zeroes at one and no plant transmission zero equals a command model eigen- 
value. The trajectory in Eq. 46 is not actually generated when the control 
law is implemented, but is useful in constructing the quadratic cost 

function and the u feedforward gain in the next section, 
m 

B. PROPORTIONAL- INTEGRAL-FILTER CONTROL LAW 


The control law is synthesized using the mathematical model of pertur- 
bation aircraft motion shown in Eq. 32. The perturbation state vector of 
the linear time- invariant model is further augmented to contain the pertur- 
bation control and is driven by the control rate. The control position and 
the control rate are both weighted in the linear quadratic cost function. 

Control rate weighting affects the discrete plant representation so 
that the discrete control system is synthesized to use one-step delayed 
sensor state information. The result is that a one sample period compu- 
tation delay is accommodated by the control law. Integral states are also 
augmented to the state vector to operate on the error between the aircraft 
states, Ay;, and the command generator output Ay^. The integral states 
cause Ay to track a constant Ay^ in steady state if: 1) the control system 
is stable, 2) the integrator gain is invertible, and 3) the discrete plant 
has no transmission zeroes at 1.0 (i.e. , the plant quad partition matrix 
in Eq. 47 is invertible). 

Assuming that the control, Au., the control difference, Av, and the 
Euler implemented integrator states, A£_, are constant over a sampling 
interval. At, the discrete plant representation becomes: 


<f> 



“Ax" 
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’ Ax“ 
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Au 
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k+1 

_AtH AtD I _ 


_A£. 
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Av. + 
— k 


0 
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Aw. 
— k 


(48) 
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$ is the state transition matrix and T is the control effect matrix. The 
matrices H and D determine the aircraft output that is integrated to pro- 
duce the control law ! s Type 1 property. 

The tracking objective of the control law is introduced into the 
design by defining the variables 



II 

1 

Ax* 

i* 

II 

$ 

(49) 

A 4 

= Av^ - 

A 21 

(Ax , . - Ax ) /At 
-m,k+l — m,k 

(50) 

l uif 

<3 

= A 4- 

A — k 

; AiJ - [a*J AuJ Aj£ ] 

(51a, b) 


and the discrete cost function 


J = 


1 im 

N+oo 


1_ 

N 


N 


I I Ax£ Q Ax + 
k=-l k k 


Ax^ M Av^ 4- Av£ R Av^ j 


(52) 


The cost function weighting matrices are determined by first specifying a 
continuous cost function for the continues plant model augmented with 
Au. and Aj£; then converting to the equivalent discrete form which accounts 
for vehicle behavior between iterations. 

The states that are available for feedback are represented as 


C Av, 

— k 


a 4eas 
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’ Ax " 
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The states observed from the aircraft model are corrupted by white Gaussian 
measurement noise Av^. with covariance, V. The control internal states Au. 
and A? are noise free. The class of control laws considered are restricted 
to be of the form 
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K 


Av. = -[K K K r ] 
-k y u t, 




•MEAS 


Au 


L A ^ Jk 


( 54 ) 


The necessary conditions for the feedback gain in Eq. 54 to be optimal are 
in the next section. The derivation from Eq. 54, to the implementable con- 
trol equations is the same as in Ref. 4, except for the computation of 
The star trajectory for is derived in Eqs. 74 to 77. Using as de- 
fined in Eq. 76, the implementable equations for the control law are 


u. = u. . + At v. - + A n -(x . - x t 
— k — k-1 — k-1 21 — m,k -mi, k-1 


-k-1 Z MFAS,k-l C A 11 -^m,k-l 


\-l 


(I - At K u ) v k _ 2 - - e^_ 2 ) - At K ? (^_ 2 - 

K 


um 


+ (K r A + K C A 10 + K A 9 ) (u - u ) 

t, y 12 u 22 — m,k “m,k-l 


(55) 

(56) 


(57) 


The perturbation variables and trim variables have been eliminated in the 
above control law expression in incremental form, using a large number of 
substitutions and cancellations. 

The gain, K um , which feeds forward the command generator forcing function 
increment, is a linear combination of feedback, feedforward and Liapunov 
solution matrices. The effect of K utn is to improve the transient response 
of the outer-loop control system by changing closed-loop system zeroes with- 
out affecting closed-loop poles. The A 21 feedforward gain in Eq. 55 is zero 
for the curved path command generator models used in this report. Ky is 
the limited state feedback gain which primarily stabilizes the outer-loop 
aircraft dynamics. K£ is the integrator gain and I-AtK u is the control fil- 
ter gain. 

C. OPTIMAL OUTPUT FEEDBACK 


For the plant dynamics shown in Eq. 48, the feedback gain constraint 
shown in Eq. 54 and the following conditions: 


E 



= 0 




(58 a,b) 


E 




(59 a,b) 
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( 60 ) 


E^Ax Ax'*' j = X 
' “-I “-I > o 

E | A " k J = E j A w k Ax^ j = e| A v k Ax^J = 0 


the cost function in Eq. 52 can be modified as follows, (Ref. 1) , 


J (K) = ± (J + J ) 
Z t s 


J = l A x , Q Ax , + 2 Ax . H Av . + Av R Av , 

t k A 0 — tk x — tk — tk — tk — tk — tk 

J = lim E < £ Ax T , Q Ax . +2 Ax T . M Av . + Av T . R Av 
s n-^ 00 N+ 1 (k=0 sk ~ i sk — sk — sk — sk — s 

J(K) = j tr|p(W + X q )J + | trj IC T (r T Pf + R) K V J 


(61) 


(62) 

(63) 

(64) 

(65) 


The notation tr denotes the trace of a matrix. J t is the transient cost with 
noise sources set to zero while J s is the average stochastic cost. The trade- 
off between J t and J s is accomplished by varying X n with respect to W . The 
effect of X Q is like adding pseudo process noise to the plant to improve con- 
trol system robustness. The benefits of using Eq. 62 as the cost function 
are discussed further in Ref. 1 and Ref. 14. 


The matrix, P, in Eq. 65, satisfies the Riccati-like equation 


P 



-T -T 

*CL +C K 


RKC + Q- MKC- 


c T k t m t 


( 66 ) 



is the stable closed-loop plant matrix. 


$ CL = $ - r K C (67) 

The necessary conditions for J (K) to have a minimum, are derived in Ref. 1. 

The necessary conditions are: 


• The gain K must satisfy 
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( 68 ) 


k |c s c T + v = r T p $ + m t sc t 


where 

s = s $1 + (w + x ) + r k v k t r T (69) 

CL CL o 

A gain which satisfies the necessary condition is not necessarily unique. 

Sufficient conditions for the existence of a gain K which minimizes 
J(K), with M the zero matrix, are derived in Ref. 1. The existence con- 
ditions are: 


£r T P r + rJ 


• There must exist a gain K so that is stable. 

• (f T Q r + R) > 0, (C(W + X o )C T + V) > 0 

A rp 

• Q H C C for some scalar £ > 0 

- -T 

• W :> e T T for some scalar £ > 0 


(70 a,b) 

(71) 

(72) 


The existence conditions can be violated and an optimal gain may still exist. 

In Ref. 4, in Eq. 51a, is determined by minimizing the performance 

index after the full state feedback optimal gains are determined, i.e.. 


Min J (Ax ) 


VA? * = Min Ax_ x 


P r Ax 
f “-1 


VA£* 


(73) 


Pf is the full state feedback Riccati equation solution. The minimum cost 
for output feedback is expressed differently from Eq. 73 as shown in Eq. 65. 

If a feedback gain is suboptimal with respect to full state feedback, the 
suboptimal cost, J s (Ax ^) is given by, 

J (Ax ) = Ax^- P Ax > J (Ax n ) (74) 

s — -1 — _i — -i “ — _1 

where P is the unique, symmetric, and positive definite solution of the 
Lyapunov equation 
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( 75 ) 


_ T " 1 n~> rn A A A __ — T* T /N'T 1 

P = C P 0 + C K R K C + Q - M K C - C K M 

L*Li OLi 


Note that P and P in Eq. 66 are equal. The value for can be determined 

exactly as in Ref. 4, using P. The Ajj* equation derived in Ref. 4 is given by 


AC* = [0 A] 


X 1 

—m,k 


u 


L^m,k+lJ 


(76) 


where 


- - p « [ 


P x? A 12 + P u? A 22_ 


(77) 


The partitions P^, P x^’ P u^ P in Eq# ^ match the partitions of Ax in 
Eq. 51b. 


D. WAYPOINT PATH CONSTRUCTION SUMMARY 


The procedure for constructing a desired path consisting of great 
circles connected by arcs of circles, fixed on the surface of a rotating 
spherical earth, and rotating with the earth, is presented in Ref. 9. In 
this section, the input data needed to construct the path and the output data 
the path generates are summarized. 

If N is the number of waypoints (N must be at least three) , then at 
each waypoint the following is supplied. 


A (I) = longitude in degrees (78) 

6(1) = latitude in degrees (79) 

h(I) = altitude in meters (80) 

CAS (I) = airspeed in meters/sec (81) 

I = 1, N 

At each interior waypoint, the following is needed 


R^(I) = radius of the turn (meters) (82) 

1=1, N-2 
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Quoting from Ref. 9, "The path is constructed by sequentially connecting 
each pair of waypoints by a great circle arc on the surface of the earth. 

At each interior waypoint, a circle is constructed by the intersection 
of a circular cone from the center of the earth to the surface of the earth. 
The radius of the circular conical base is taken to be the input turn 
radius at that interior waypoint. The center of the cone is chosen so that 
the circle is tangent to both the incoming great circle and the outgoing 
great circle". 

The initial and final waypoints as well as each interior middle-of-the- 
turn waypoints are assigned a desired altitude and airspeed from Eqs. 80 
and 81* The gradient in altitude and airspeed over each segment is 
determined by dividing the difference in altitude or airspeed by the ground 
track distance. Altitude and airspeed commands are smooth ramps between 
desired values. 


After the path is constructed and the aircraft is flying the path, the 
following RNAV guidance parameters are generated, 


Cross track error --------- 

Track angle error ---------- 

Distance to go to the end of the leg 
Time to go to the end of the leg - ■ 
Desired altitude and altitude rate ■ 
Desired airspeed ---------- 

Desired flight path angle ------ 

Desired bank angle in the turn - - ■ 


Ac 

A? 

r l 

t l , 

h c ,h c 

CAS c 

Y c 


The bank angle command is switched to the value it should have in the 
turn as soon as the time to go to the great % circle is less than the bank 
command divided by the maximum bank rate, 4 ) max # At t * ie en d of the turn, 
the bank command is returned to zero when the time to go is less than the 
time to return the bank angle to zero at the maximum bank rate. Anticipatory 
bank angle commands decrease the cross track error. 


The information in the waypoint commands shown above is used to develop 
the command models and the command errors in the next section. In the lateral 
dynamics, only command errors are available, Ac and A£, while In the longitudinal 
dynamics, absolute command values are available, h c and CAS c . 


E. LONGITUDINAL COMMAND MODEL CONTROL SYSTEM 


The outer-loop control system uses a command model which is regulated 
by a non-linear command model control system. When the outer-loop control 
system is engaged, the internal states in the command model are initialized 
to the aircraft states. After initialization, the control law follows 
state trajectories generated by the command model. The command model con- 
trol system is designed simultaneously with the feedback/feedforward gains 
in Eq. 57 to provide good ride quality and command limiting. 
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The longitudinal command model uses a double integration of vertical 
acceleration to generate the vertical path trajectory. The CAS trajectory 
is one integration of forward acceleration, 
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( 83 ) 


The command model controls are computed using 
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(84) 


The variables with the c subscript are the commands from the waypoint path 
generator. The command model controls are magnitude limited to acceptable 
values |h m | ^ , |CAS m | ^ CASMAX. Flight tests of a similiar vertical 

command model in Ref. 4 provided values shown in Table 2 for k^, kfi and 
the acceleration magnitude limits that pilots favor. All of the equations 
for the command model control system are shown in Appendix B. 

The outer-loop control system detects if the command model is initial- 
ized away from the desired path and internally chooses a vertical velocity 
command, h c =2.53 m/s (8.3 fps), to return to the path. The linear model 
version of Eq. 83 is used in Eq . 44. The linear model controls are assumed 
to be hm and CAS m as discussed in Ref. 4. 


The construction of the command error, fundamentally affects the 

control system feedback robustness properties as well as the closed-loop 
plant transient response to commands and disturbances. A generic longitudinal 
command error of the form 




k (h - h , ) + k_(h - h . ) + k~(CAS, 2 - CAS 2 , ) 
1 k m,k 2 k m,k 3 k m,k 


CAS, - CAS , 
k m,k 


(85) 
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was investigated. If ki=1.0, k2=0.0, and k3=1.0/2g, for example, the longi- 
tudinal control system causes h to track h m and CAS to track CASm, but energy 
error and CAS error are the quantities regulated in the control system during 
transients. A number of combinations of k]_, k2 , and k 3 were investigated. 
Three designs were completed and are candidates for flight testing: 


LONl : 

k l = 

1.0, 

k 2 = 0.1, 

LON 2 : 

k l = 

1.0, 

k 2 = 10.0 

LON 3 : 

II 

i—l 

& 

1.0, 

k 2 = 20.0 


k 3 = 0.0 
, k^ = 0.0 

, kg = 0.1 


The results in Chapters IV, V and !VI make comparisons between the different 
longitudinal command error designs. 

F. LATERAL COMMAND MODEL CONTROL SYSTEM 


The lateral command model operates differently from the longitudinal 
command model because of the different commands generated by the path 
guidance system in Section III D. The command model is used to smoothly 
capture the horizontal path when the system is engaged. After capture, 
the command model states are essentially zero and the command model cal- 
culations are deactivated. The command model uses the dynamical relation- 
ship between lateral position and velocity heading and the relationship 
between heading and roll angle for a coordinated turn, Ref. 15, 


Ac: - = Ac + At V nc . sinAC 1 

m,k+l m,k GS ,k m,k 
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The model control is (j)^. The linear model used in Eq. 44 is a linearized 

version of Eqs. 86 and 87 for straight-and-level flight. The linear model 

control is (f> m . The variable g is gravity. The variable V is ground speed. 

Go 

The control system for the nonlinear command model is 



Ac , -(k V GS)A? , 

m,k C m,k 
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The gain feeding back A^ m varies as a function of ground speed in an attempt 
to keep the command model closed-loop system eigenvalues invariant with 
respect to changing V . The roll rate is limited to a maximum value, 

trO 



* <f> 


MAX 


(90) 


If the aircraft is close to the desired path, i. e., | Ac | ^ 900m or 
| AC | ^ 30 deg, the control system uses a maximum bank angle, 4>MAXl» to 
turn. If the aircraft is far from the desired path, a new bank angle 
maximum is calculated to ensure that the capture can be performed without 
over-shooting the path, 
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Equation 91 is determined by integrated Eqs. 86 to 88 for the constant 
bank angle that results in Ac=0 from some initial condition A^ 0 and 
Ac q . For safety reasons, <$>max2 cannot exceed an absolute maximum bank 
angle ^MAXS* va lues for and 4 ) MAX3 are s ^own in Table 2. If 

the intercept angle A£ 0 exceeds 30 deg, the command model control system 
is activated only when the roll rate command causes the bank angle to roll 
away from the horizontal path, i. e., fc A£ £ 0.0 ; a capture feature 
pilots favor. 

The command model shown in Eqs. 86 to 88 was flight tested and the re- 
sults are reported in Ref. 4. Three different command errors were flight 
tested 
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Yaw angle, T, was used in Ref. 4, instead of A£ but the conclusions and 
operations are essentially the same because sideslip is usually zero and 
the angle of attack is small. 

In LOCI, the objective of the aileron and rudder is to null roll angle 
and cross track errors. The control system will track a straight horizontal 
path wings level. L0C2 uses the philosophy of a three tiered nested ap- 
proach commonly used in commerical autopilots. A wings leveler, which 
causes the error 0^ - to be zero, can be upgraded to a track angle hold 

autopilot by replacing the roll command with a track angle error command, 

0k - k4 (A^-A^xn^k) • The track hold autopilot can be upgraded to a cross 
track autopilot by replacing ACtn^k with cross track error as shown in Eq . 93. 

The parameter ak is a roll command to rudder command crossfeed gain and 
is used to change rudder trim position in a turn so that the steady-state 
sideslip angle is zero . If ak is zero, then commanding steady state rudder 
position to a trim value, 5 mr , as shown in Eq. 93 operates much like a yaw 
damper. The rudder is used to stabilize the aircraft, and damp Dutch roll 
in the transients; but is forced back to 6 mr in steady state. L0C2 is sim- 
iliar in philosophy to a localizer autopilot discussed in Ref. 2. In L0C3, 
only the cross track error is used to command the bank angle. The 6 m r command 
in Eq. 93 and Eq. 94 can be either programmed in software or the measure 
value of rudder at control system engage can be used. 

The flight tests in Ref. 4 clearly showed, that from a capture and 
track viewpoint, L0C3 is the better all around design. L0C3 is used for 
the outer-loop lateral control system in this report but with the following 
modification 
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The known value for the roll command from the waypoint guidance 
system is included in the command error equation. Two different lateral 
control designs were investigated and are candidates for flight testing. 


LATl : k ? = 0.5 

LAT2 : k ? = 1.0 
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IV. CONTROL DESIGN AND NONLINEAR SIMULATIONS 


This chapter presents the control system design parameters and some of 
the closed-loop simulation evaluations. There are three different designs for 
the longitudinal dynamics: L0N1, L0N2 and L0N3 as discussed in Chapter III. 

L0N1 and L0N2 are designed using 5 and 20 samples per second. L0N3 is de- 
signed using 5 sps for a total of five longitudinal control system options. 
There are two different designs for the lateral dynamics: LAT1 and LAT2. 

LAT1 is designed using 5 and 20 samples per second and LAT2 is designed 
using 5 sps for a total of three lateral control system options. 

L0N1 is a hierarchical design. First the elevator control loop is de- 
signed using the height error integrator. The elevator loop is closed, then 
the throttle loop is designed using the CAS error integrator. The height 
error integrator is not fed back to throttle and the CAS error integrator is 
not fed back to elevator. Elevator has a higher bandwidth than throttle and 
the control system can be considered to have vertical path error priority 
over airspeed error. During maneuvers, the throttle sometimes saturates and 
the control system must stabilize the vehicle using only elevator. The 
hierarchical approach guarantees that the control system is stable when 
throttle saturates. 

L0N2 is an integrated design. Throttle and elevator are designed simul- 
taneously using the multivariable plant model. Both Type 1 integrators have 
feedback paths to both control effectors. When throttle saturates, there is 
no guarantee that the remaining elevator control loop is stable. Numerical 
tests for stability are necessary using closed-loop eigenvalues. The single 
elevator control loop achieves closed-loop stability throughout the aircraft’s 
design flight conditions. The L0N2 control system has neither path error or 
airspeed error dominating control priority. 

L0N3 is also an integrated design. As shown in Chapter III, airspeed 
error appears in both integrators. The control system is considered to have 
airspeed error priority over path error priority. Chapter V indicates that 
L0N3 has slightly better stability margins than L0N2 and L0N1. This chapter 
shows that L0N3 also has better simulation performance. 

LAT1 and LAT2 are integrated designs. A hierarchical design for the 
lateral dynamics proved to be a poor approach. The hierarchical approach 
had difficulty in determining control gains which yielded a coordinated 
turn in simulation. LAT2 is included primarily to have at least two control 
options for comparison purposes. Chapter V indicates that LAT1 has better 
stability margins than LAT2. This chapter shows LAT1 also has better simula- 
tion performance. 
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The 20 iterations per second nonlinear simulation of the aircraft in- 
cludes 6 degree of freedom motion for the aircraft, nonlinear actuator 
dynamics, sensor models, wind shear models and random noise generators. The 
nonlinear simulation uses aerodynamic forces generated using the stability 
derivatives of the ATOPS B-737 aircraft. When the outer-loop control system 
operates at 5 sps , the control effector command can be released at any 1/20 
sec interval within the 1/5 sec sampling interval. (NMUCATI and NMUCOTI in 
Appendix B are subroutine inputs that control the command release time 
period). Releasing the control effector command early within the 1/5 sec 
control cycle does not seem to improve control performance significantly 
and is not further discussed. The control command is released as designed, 
at the end of the control sampling interval for all the simulations in this 
report. 

A. OUTPUT FEEDBACK AND DESIGN VALUES 


In this section, the states in the plant model and the output vector 
used for feedback are presented for each longitudinal design: 


L0N1: FIRST LOOP-ELEVATOR 
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The integrator states, 5^ and using Eq. 85 can be expressed in con- 

tinuous time as, 
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(97) 


«CAS ' / <CAS - CA V dt 

The observations used for feedback in the elevator loop hre pitch attitude, 
the complementary filter outputs, filtered vertical acceleration, control 
command position and the height integrator. The feedback paths in the 
throttle loop are CAS, pitch attitude, control command position and the CAS 
integrator. From a control design viewpoint, pitch attitude provides the 
throttle control system with lead information concerning the movement of 
elevator and aircraft height. 


LON 2 : ELEVATOR AND THROTTLE 
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L0N3: ELEVATOR AND THROTTLE 
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The different integrators in L0N2 and L0N3 are determined as in L0N1 
using Eq. 85. The observations used for feedback in L0N2 and LON3 are the 
combination of the LON1 observation vectors. Throttle and elevator have 
access to the same sensor information feedback paths in L0N2 and L0N3. 

The design of the control system is achieved by choosing the elements 
in the matrices Q, R, X Q , W and V iteratively until the control system has 
desired closed— loop properties. The elements in W, the process noise covar- 
iance matrix, and V, the measurement noise covariance matrix, are predeter- 
mined from the values shown in Table 1 and Table 3. All internal control 
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states, such as an integrator state, have zero measurement noise. Iterative 
adjustments are made to Q, R, and X Q until one set of numbers could be used 
for all three longitudinal control designs at all eight design flight con- 
ditions. 


The design parameters for the longitudinal control systems are shown in 
Table 4. The large initial condition values for X D dominate over the process 
noise covariance matrix W, when the two matrices are added in Eq. 69. The 
large initial condition values for the control states are useful in increasing 
frequency domain stability margins as discussed in R e f s. 14 and 10 . 

The states in the plant model and the output vector for each lateral 
design are presented next. 


LAT1: AILERON AND RUDDER 
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The observations used for feedback in the lateral control loops are roll 
attitude, track angle error, cross track error, control command position 
and the integrators. 

The design parameters for all the lateral control systems are shown 
in Table 5. The measurement noise for Ap and Ar are absorbed into the pro- 
cess noise covariance when the inner loops are introduced into the aircraft 
model. A large weight is placed on Av in an attempt to make the aircraft 
bank-to-turn with little sideslip , i.e., a coordinated turn. A large weight 
is placed on Av r to keep the outer-loop command rudder rate small . 

B. GAIN SCHEDULING AND CLOSED-LOOP EIGENVALUES 


The control laws are adapted to changing airspeed by scheduling their 
gains as a function of CAS. Figure 6 shows the pitch L0N3 optimal gain and 
scheduled gain as a function of CAS. The abrupt change in the two gains in 
Fig. 6 at 92.6 m/s (180 kt), a trend evident in most of the other gains, 
caused the gain schedule for all the gains to be computed in two groups. 

One group uses the four design flight conditions 61.7 m/s (120 kt), 69.4 
m/s (135 kt), 77.2 m/s (150 kt), and 84.9 m/s (165 kt) to find a \ and a 2 
in the scheduling equation 


GAIN = a x CAS + a 2 (98) 

The other group uses the four design flight conditions 92.6 m/s (180 kt) , 
123.5 m/s (240 kt) , 138.9 m/s (270 kt) and 154.3 m/s (300 kt) and regression 
analysis to determine a 3 and a 4 in 

GAIN = a 3 CAS + a 4 (99) 

The coefficients a^-a 4 for all the control designs are given in Appendix A. 

The correlation coefficient for more than eighty percent of the gains is 
above 0.9. 

The gains are updated in flight and simulation once every second. An 
easy-on is used to transition the gains between updates, 

__ o A 4- /\ _ o 

GAIN k = (1 - e ) GAIN k _ 1 + e GAIN k (100) 

The easy-on operates at the outer-loop sample rate. The parameter a in 
Eq. 100 is 2.0. The easy-on is particularly useful during the 92.6 m/s 
(180 kt) gain transition point in CAS shown in Fig. 6 . 
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The stability characteristics of the closed-loop digital flight control 
system are described by the eigenvalues of the closed-loop linear model 
system matrix. The closed- loop linear model system matrix, $CL> is computed 
as follows, 
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The degree of involvement of each state variables in each mode of motion is 
identified by the corresponding eigenvectors of $CL* For discrete-time 
systems, root locations within the "unit circle" indicate stability, but 
these root locations are difficult to interpret. A useful method for evalu- 
ating discrete root locations is to map them into an equivalent continuous- 
time representation using natural logrithms. 

Table 6 shows mapped closed-loop eigenvalues for each longitudinal and 
lateral control design at one flight condition. The mode definition in 
Table 6 is representative, since the table indicates that some complex modes 
split and recombine with other modes as the control structure alters. The 
column marked INNER-LOOP shows the plant eigenvalues before the outer-loop 
control system is closed. The inner-loop control system stabilizes the 
fast aircraft modes of motion (short period and Dutch roll) with good damping. 
The outer-loop control system alters the short-period root locations, but 
further increases the damping ratio to near critical damping (£=0.707). The 
lateral outer-loop control system tends to destabilize the Dutch roll mode. 

The different sampling rates used for the outer-loop designs (20 sps 
and 5 sps) have a small effect on eigenvalue locations. In most cases, the 
complex mode damping actually increases when the 5 sps design is compared 
to the 20 sps design. The L0N1 control design has complex eigenvalues 
(associated with Af^l) with the poorest damping. 

The effect of the gain schedule on closed-loop eigenvalue location is 
small. There are differences but the scheduled gain closed-loop eigenvalues 
remain close to their optimal counterparts with reasonable damping. The 
L0N3 control system has the best match between optimal and scheduled closed- 
loop eigenvalues and is closely followed in eigenvalue match performance by 
the LAT1 design. The L0N1 control system has the poorest match. 

A demonstration of the effect of airspeed on closed-loop eigenvalues 
is shown in Table 7. The real part of the Dutch roll mode remains almost 
constant while the imaginary part decreases with velocity. Dutch roll 
damping is increased as the natural frequency decreases with airspeed. The 
damping of the short period mode, the task of the inner-loop control system, 
is significantly decreased as velocity increases. The short period damping 
reaches a value of 0.22 near 154 m/s. 
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The inner-loop phugoid mode in Table 7 is stable below 84 m/s, then 
changes abruptly near 92 m/s and becomes unstable as airspeed increases. 
The gain scheduled outer-loop control systems stabilize the phugoid mode 
with high damping as the airspeed changes from landing approach values to 
high speed cruise velocities. In the LAT1 control system, the cross track 
mode is almost critically damped at low velocities as shown in Table 7. 
Increasing airspeed causes the cross track mode natural frequency to de- 
crease but the damping remains high (C>0.59). 

C. ALTITUDE CAPTURE SIMULATION 


The command model interface between the waypoint path generator and the 
outer-loop control system allows the aircraft to be remote from the desired 
path when the control system is engaged. When the aircraft is engaged above 
the flight path, the command model establishes a path the aircraft follows 
using a standard rate of descent, 2.5 m/s (8.3 ft/s), to capture the waypoint 
path with no overshoot as depicted in Fig. 7. 

Nonlinear six degree-of-f reedom simulations of the three longitudinal 
control systems operating at 5 sps for an altitude capture are shown in Fig. 
8. The wind, measurement noise and gust disturbances are inactive in the 
simulation. The captures are smooth with little overshoot. The lower damp- 
ing of the modes in the L0N1 control system, as shown in Table 6, are evident 
in the LON1 simulation for li. Maximum CAS deviations during the descent 
are approximately 2 m/s (~4 kts), for all three designs. 

D. CAS CAPTURE SIMULATION 


Changing the calibrated airspeed of the aircraft over a wide range is 
an important test of the gain schedule part of the outer-loop control system. 
Figure 9 shows each control system changing CAS from an initial value of 
77.2 m/ s (150 kt) to 129 m/s (250 kt) at an altitude of 305 m (1000 ft). The 
initial CAS rate of change is limited to 0.76 m/s^. The CAS command model 
control system causes the CAS response to have a smooth capture. Flaps 
change position as a function of airspeed in Fig. 9 and is one source of 
height error as airspeed increases. The other source of height error in Fig. 

9 is the manner in which the different longitudinal outer-loop control systems 
regulate potential and kinetic energy. 

The airspeed increases faster if the aircraft is allowed to descend 
slightly at the beginning of the maneuver. In other words, potential energy 
is allowed to decrease initially to obtain a fast increase in kinetic energy. 
The integrated designs, L0N2 and L0N3 both exhibit an initial loss in altitude 
of approximately 25 m (~ 80 ft). The L0N1 hierarchical design simulation on 
the other hand, actually shows an initial increase in height at the beginning 
of the simulation. 

The L0N1 hierarchical design keeps total height variation small (10 m < 

(~ 30 ft <)) as airspeed increases. Airspeed responds slower, however, in the 
L0N1 hierarchical design approach. L0N2 and L0N3 require approximately 100 
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sec to complete the CAS change while L0N1 requires 160 sec to perform the same 
velocity maneuver. Smaller height variations with changing airspeed could be 
made by L0N2 and L0N3 if the maximum rate of change of the command model CAS 
command is reduced. The maximum rate of change of CAS is an input variable to 
the control subroutine in Appendix B and has no effect on closed-loop stability. 

An important transfer point in the CAS simulation occurs when CAS crosses 
92.6 m/s (180 kt) . Some control gains change quickly in this region, but 
little effect of the change is evident in the simulation. 

The only noticeable CAS simulation difference between L0N2 and L0N3 occurs 
in throttle. Throttle is smoother and settles faster in L0N3 past 78 seconds 
into the simulation. 

E. HORIZONTAL PATH CAPTURE 


A horizontal path capture is similiar to a localizer bean centerline 
capture during a landing approach. Figure 10 shows the horizontal path 
geometry. The aircraft is heading towards the desired path and the aircraft 
control system is engaged approximately 3500 m (4 mi) from the path. The 
nonlinear 6-DOF simulation for the LAT1 control system is shown in Fig. 11. 
The command generator leaves the aircraft on course after computing the 
desired maximum bank angle using Eq. 91 which captures the path in one 
turning sequence. The command generator begins the turn when the command 
generator control system indicates the aircraft should roll away from the 
path. The coordinated turn is accomplished with a no overshoot capture. 

F. WIND SHEAR SIMULATION 


Wind shear has been recognized as a significant factor in commercial 
transport accidents during takeoff and landing, (Ref. 16). The nonlinear 
6-DOF simulation used to evaluate the control designs, contains the wind 
shear /turbulence package developed by the Standard Research Institude, (SRI) 
(Ref. 17). The control designs in this report are not specifically designed 
to counteract wind shear and do not contain wind shear internal models for 
estimation and disturbance accommodation. The effect of wind shear is an 
important indication of the control systems performance, however, and simu- 
lations are presented in this section for the three longitudinal control 
designs . 

One of the most severe wind shear models in the SRI package is Profile 
D4, a high severity thunderstorm wind shear. The horizontal wind increases 
from 0 to a 50 kt head wind initially, then rapidly changes to a 30 kt tail- 
wind as the aircraft nears the touchdown point during landing. Coincident 
with the change from a headwind to a tail wind, a vertical downdraft of 10 
kt and of short duration, 15 sec, is also simulated as part of the shear 
profile. Figure 12 shows the atmospheric condition which could generate 
the Profile D4 wind shear. All three longitudinal control designs fly 
successfully through the wind shear avoiding both stall and premature ground 
interception. 
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The effect of the wind shear for each longitudinal control design is 
shown in Figs. 13 and 14. The aircraft is simulated progressing down a 3 
deg glidelsope with wind gust and sensor measurement errors not activated. 
The glideslope descent path changes to level flight 9 m (32 ft) above the 
runway at approximately 125 secs into the simulation. The wind shear and 
vertical downdraft occur between 110 and 120 seconds into the simulation. 

L0N3 exhibits the best, i.e., the smallest, path error response in 
vertical height (± 12 m) . L0N1, the hierarchical design, has the largest 

path error (23 m below - 44 m above the glideslope) . L0N2 operating at 
20 sps, has the best CAS response, i.e., CAS stays above 59 m/s (115 kt) . 
L0N1 experiences the worst CAS response but still avoids stall. 

Throttle response for each control design is shown in Fig. 14. The 
upper limit on throttle is a function of engine pressure ratio, EPR, and 
the CAS error in the control integrator y-y m as shown in Appendix B. If 
the CAS error is small, then the upper limit on throttle decreases from 
60.0 deg (the physical maximum) at EPR = 1.2 to 42.0 deg when EPR = 1.85. 
The throttle limits are determined using the steady state relationship 
between EPR and throttle. The objective of the throttle limit is to keep 
EPR below 1.85 under normal operating conditions. Keeping EPR below 1.85 
is also the objective of the inner-loop autothrottle control system shown 
in Fig. 4. If the CAS error is large (> 4.1 m/s (8 kts)), EPR and throttle 
for the outer-loop control design in this report are allowed to increase 
as CAS error increases up to the physical maximums (60 deg for throttle). 
The lower limit on throttle is increased from 0 at 131 m/s to 10 deg at 
101.8 m/s to keep the engines from completely spooling down at low veloc- 
ities . 

In all four wind shear simulations, throttle increases to the 60 deg 
limit at 20 sec into the simulations and EPR reached a value of ~2.1 as 
shown in Fig. 14. The control systems recognized the abnormal situation 
and allowed throttle to reach full authority in order to reduce the command 
errors. The 42 deg limit for throttle is activated for the L0N3 (at 5 sps) 
and L0N2 (at 20 sps) control systems 135 sec into the simulations. The 
CAS error for these two control designs is kept within tolerance values 
during the 135 sec - 145 sec time period. 
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V. FREQUENCY DOMAIN EVALUATION 


The linear control systems designed in Chapters III and IV are eval- 
uated in this chapter using frequency domain concepts. Frequency domain 
evaluation is useful in judging control system performance when the plant 
is subjected to various types of uncertainties. An excellant discussion of 
these concepts is given in Ref. 10. 

The evaluation in this chapter concentrates on the effect of additive 
alterations at the input to the plant model. In Fig. 15, the plant loop 
is broken at point i and the loop transfer function is computed as (with 
AG(s) zero), 


u = (I + K(s)G(s) ) 1 u* 


( 102 ) 


In single- input , single-output plants, the performance objective is usually 
viewed as observing how close K(s)G(s) evaluated at s=jco is to -1.0 as the 
frequency, 0), is varied over a frequency range of interest. The resulting 
Bode gain/phase plot gives an indication of how close 1 + K(s)G(s) is to 
being zero. 

For multi-input, multi-output plants. Ref. 10 argues that one type of 
performance evaluation for a closed-loop system is to compute how close the 
return difference matrix, I + K(s)G(s), is to being singular using singular 
values. The singular values are computed by substituting joj for s and 
varying co in the return difference matrix, I + K(ja))G(jaO , over a frequency 
range of interest. A plot of the singular values of the complex matrix, 
i.e., a [I 4 - K(jco)G(jaj) ] » is called a sigma plot. The singular values are 
plotted in this report in units of dB using 20 log O. As O approaches 0, 
the dB values approaches - 00 . 

Unlike Bode plots, a problem with sigma plots is that it is not clear 
what constitutes a poor sigma plot, i.e., a less than satisfactory control 
design. Recent publications. Refs. 18 and 19, have shown that sigma plots 
tend to be conservative. If a sigma plot indicates a potentially poor design, 
the actual performance of the control system, when physically realizable 
uncertainties occur, is unclear. It is clear, however, that a "good" sigma 
plot does result in a satisfactory control design. If the performance 
characteristics of the full state feedback continuous-time linear quadratic 
regulator (LOR) is judged as a potentially "good" design, the performance 
characteristics are, Ref. 8, (with R = pi, p is a scalar). 


£[I + (jwI-A)B] 2 1 0 < 0 ) < co (103) 
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Expressed in dB, sigma plots above 0 dB indicate a good design while 
sigma plots below 0 dB are potentially poor. In the single-input case, 
sigma plots above 0 dB correspond to 60 deg of phase margin and infinite 
gain margin. 

Past research efforts in sigma plots have primarily concentrated on 
continuous-time additive alterations, AG(s) in Fig. 15, and multiplicative 
alterations to continuous-time plants. The outer-loop control design in this 
report is discrete. The discrete system counterpart to Fig. 15 and Eq. 102, 
as discussed in Ref. 8, is determined using the z-transform. The loop 
transfer function is computed as (with AG(z) zero), 

u = (I + K(z)G(z)) -1 u* (104) 


The discrete system sigma plots in this report are computed by substituting 
z = into the discrete return difference matrix I Hh K(z)G(z). Singular 

values are computed using the complex matrix, I + K(e^ w t )G(e^ w t ) , and 
varying the frequency 00. What constitutes a "good" sigma plot for the 
discrete-time systems is currently an open question. As the sampling time 
approaches zero, it has been shown in Ref. 20 that the discrete-time 
sampled-data linear quadratic regulator frequency domain properties approach 
the continuous-time properties. 

A. SINGULAR VALUES AND BODE PLOTS 

This section compares outer-loop sigma plots and Bode plots for the con- 
trol system designs. The comparisons are computed for the L0N2 and LAT1 
outer-loop control systems operating at 5 sps and 77 m/s CAS. The point 
where the control loop is broken for the outer-loop control design is shown 
in Fig. la. The inner-loop control system, actuator dynamics and aircraft 
dynamics are lumped together as the continuous-time plant. Sigma plots can 
be determined at point i for the 5 sps and 20 sps control designs. If the 
control loop is broken at the actuator input, the inner-loop control system 
would have to be modeled as a discrete system and the control system would 
be multirate when the outer-loop controller operates at 5 sps. Multirate 
control evaluation using sigma plots is beyond the scope of this work. 

Single loop Bode plots in this report are obtained by opening one con- 
trol loop while leaving the other control loop closed and plotting gain and 
phase of the scalar complex number K(eJ a3 ^ t )G(eJ a3 ^ t ) . A single loop singular 
value plot is obtained by adding 1.0 to K(e5 w ^ t )G (eJ^t) anc j plotting the 
resulting complex number magnitude in dB. Breaking the throttle loop at 
point i’ for the L0N2 outer-loop control system operating at 5 sps and 77 
m/s CAS produces the sigma plot and Bode plot in Fig. 16. The smallest 
value for (J is -2.7 dB at 0.2 rad/sec. At 0.2 rad/sec, the L0N2 throttle 
Bode plot has a gain of -7.3 dB and a phase of -138 deg. The L0N2 throttle 
phase margin is 57 deg and the gain margin is -18.5 dB, an excellent design. 
The minimum singular value does not usually occur at the crossover frequency 
as shown in Fig. 16. The L0N2 control system’s high gain feedback in the 
low frequency range is caused by the integrators. The LON2 control system’s 
good roll off at high frequencies is caused by the u t filter in PIF. 
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Breaking the loop at i ! for the LAT1 rudder outer-loop control system 
operating at 5 sps and 77 m/s CAS produces the sigma plot and Bode plot in 
Fig. 17. The rudder command error integrator causes the control system to 
M wash-out n low frequency inputs to rudder. The smallest singular value is 
-3.5 dB at 0.53 rad/sec. At 0.53 rad/sec, the LAT1 rudder Bode plot in Fig. 

17 has a gain of -8.7 dB and a phase of -160 deg. The phase margins for 
the LAT1 rudder loop are 174 deg and 93.1 deg. The gain margins for the 
LAT1 rudder loop is -10 dB and -50 dB, all good single-input design values. 

Breaking the loop at point i for the L0N2 control system operating at 
5 sps and 77 m/s produces the maximum and minimum singular value plots in 
Fig. 18. The first minimum singular value, -3.0dBat 0.21 rad/sec, corre- 
sponds to the single- input throttle minimum in" Fig. 16. The second minimum 
singular value, -3.2 dB at 1.1 rad/sec, corresponds to the single-input ele- 
vator minimum in Fig, 19. Overall, there is not a significant difference 
between single-input sigma plots and multi-input sigma plots for the long- 
itudinal control systems. 

The lateral control system has a completely different conclusion. 
Breaking the loop at i for the LAT2 control system operating at 5 sps and 
77 m/s CAS produces the two singular value plots in Fig. 18. The minimum 
singular value in Fig. 18b is 12.3 dB below either minimum single-input 
singular value in Figs. 17 and 20. The minimum singular value of -17.3 
dB at 0.44 rad/sec in Fig. 18b is a strong departure from the single-input 
indications of control system robustness for aileron and rudder. Figure 

18 is considered to be an example of the conservativeness inherent in 
singular value analysis. Numerous quadratic weight adjustments did not 
improve the minimum value in Fig. 18b significantly. The frequency of 
the minimum singular value indicates the inner-loop control system is 
actively involved in generating the result shown in the figure. Contrary 
to Fig. 18b; nonlinear simulations, closed-loop eigenvalues and single- 
input Bode plots all indicate that the lateral control system design has 
acceptable performance. 

B. EFFECT OF SAMPLE RATE 


Two longitudinal control system configurations, L0N1 and L0N2 , and one 
lateral control system, LAT1, are designed at two sample rates, 20 sps and 
5 sps. Figures 21 and 22 show the effect of different sample rates for 
single loop breaks at point i f . The different sample rates have little 
effect on LAT1 and L0N2 control system gain as a function of frequency. 

The different sample rates have a larger effect on the control system phase, 
especially at high frequencies. The phase margin for the aileron loop 
changes from 45 deg at 20 sps to 35 deg at 5 sps, a significant degradation. 
The phase margin for the rudder loop changes from 100 deg to 90 deg. The 
L0N2 throttle loop shows no change in phase margin with sample rate. The 
elevator loop phase margin degrades only 2.0 deg. 

The multi-input singular value effects of different sample rates can be 
observed by comparing Table 8 and Table 9 for the L0N2 design and comparing 
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the results in Table 10 for the LAT1 design. There is a 0.5 dB (approx- 
imate) minimum singular value improvement using the higher sample rate for 
L0N2 (this corresponds to a 3.0 deg phase change) . The singular value 
improvement for LATl is 0.3 dB or less. Single- input Bode plots give a 
better relative indication of control system performance degradation as the 
sample rate decreases when compared to multi-input sigma plots for the con- 
trol designs in this report. 

C. EFFECT OF AIRSPEED 


The primary effect of airspeed on the longitudinal designs is that 
the control system low frequency stability properties improve with air- 
speed. The increase is apparent when the minimum singular values are 
compared in Tables 11, 8 and 12 for the L0N1, L0N2 and L0N3 control sys- 
tems, respectively. The high frequency stability properties degrade in 
L0N1 and L0N2 but remain fairly constant in L0N3 as airspeed increases. 
Another trend evident in the tables is that L0N3 has better frequency 
domain stability properties than L0N2 and L0N2 has better stability pro- 
perties than L0N1. 

The single-input frequency response for the lateral designs indicate 
that the stability properties improve with airspeed as shown in Tables 13 
and 14. The minimum singular values in Table 10 for the multi-input sigma 
plots indicate that the stability properties degrade with airspeed. The 
single-loop frequency response is considered to be a better indication of 
actual control system performance for the lateral outer-loop control de- 
signs. The LATl control system stability properties in Table 13 are 
better than the LAT2 control system stability properties in Table 14. 
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VI. CURVED TRAJECTORY SIMULATION 


The performance of the 3D RNAV control system described in the pre- 
vious chapters is evaluated in this chapter along a complex curved tra- 
jectory in the terminal area. Two versions of the nonlinear six degree 
of freedom simulation along the curved trajectory are presented. The 
first version has all external noise and disturbances deactivated. The 
second version has all noise and disturbances (except for wind shear) 
activated. The noise and disturbances include a steady wind of 10 kt 
moving east to west, the sensor noise and bias errors shown in Table 3 
and wind gusts from a Dryden model with a standard deviation of 0.3 m/s 
(1.0 fps). The waypoints and the aircrafts initial trim conditions 
are shown in Table 15. The horizontal curved trajectory generated by 
the waypoints and the steady wind direction are shown in Fig. 23. 

The curved trajectory begins with the aircraft flying straight and 
level with the flaps fully extended at 40 deg. The aircraft rolls left, 
flys level for a short time, then rolls right and enters a circular turn 
with a 233 deg change in heading. During the first roll to the left, the 
aircraft begins to descend at a steep rate, 7.2 m/s (23.6 ft/sec). The 
trajectory of the aircraft is a descending spiral during the circular 
turn part of the trajectory. After completing the 233 deg change in head- 
ing, the aircraft, still descending, flys level for a short time, then 
rolls left to line up with the runway center line. During the final turn, 
the aircraft decreases the descent rate to 3.7 m/s (12.3 ft/sec). The 
simulation is terminated at the point where an automatic landing control 
system could complete the descent and land. The latitude and longitude 
values in Table 15 correspond to Earth coordinates near the NASA Wallops 
Flight Center. 

A. LONGITUDINAL DYNAMICS 


The disturbance free simulations for the longitudinal dynamics are 
shown in Figs. 24 to 26. The simulation begins with an initial condition 
mismatch in commanded and actual CAS. The descent path is begun 25 seconds 
into the simulation. The command model limits the vertical deceleration 
and the aircraft descends to capture the path using aircraft accelerations 
which ensure passenger comfort. The value used to limit h is an adjustable 
input to the flight control system and has no effect on closed-loop sta- 
bility. Increasing the maximum allowed value of h decreases the height 
error. The maximum value of h m i n in the command model is 0.457 m/s^ (1.5 
ft/sec^), The purposeful increase in height error caused by the accelera- 
tion limit grows to between 70 and 80 m in Figs. 24 to 26. The error 
between commanded and actual vertical velocity decreases to zero as the 
simulation progresses. There is a slight etror of less than 10 m in the 
height response because of the control system’s Type 1 response. The con- 
trol system decreases throttle during the descent to keep airspeed from 
increasing. 
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The changes in height and vertical velocity after 180 sec into the 
simulation are caused by the rolling motions of the aircraft. A cross- 
axis term which feeds back roll angle squared to elevator is used in the 
control design and aids in decreasing height error during turns. 

A comparison of the simulations indicate L0N2 and L0N3 are almost identi- 
cal in performance. L0N1 has larger errors and less damping but overall, has 
a smoother response. The 20 sps and 5 sps longitudinal control system designs 
have similiar simulation performance. The 20 sps simulations are not presented. 

In contrast, the 20 sps and 5 sps lateral designs exhibit a noticeable 
difference as shown in Figs. 27 and 28. The 20 sps design is better 
damped and has less cross track error (6 m vrs. 22 m) . The commanded bank 
angle changes to the desired value required in a turn 5 seconds .before 
the turn commences as discussed in Chapter III D. The turns are well 
coordinated, i.e. , steady-state sideslip is zero and steady turn cross 
track error is zero. The maximum sideslip at turn entry is -1.0 deg. 

The longitudinal curved trajectory simulations with all disturbances 
activated are shown in Figs. 29 to 33. Elevator activity is kept at a 
reasonable level. Throttle activity is low and nonoscillatory . Stochastic 
performance, which is most clearly evident in the HDOT response , improves 
from L0N1 to L0N2 and further improves in L0N3. The bias in the CAS 
response is caused by the fact that the true aircraft CAS is plotted. The 
control system causes measured CAS, which contains a bias, to follow 
commanded CAS. Throttle activity for L0N1 is lower than either L0N2 or 
LON 3. 


The simulations for LONl and L0N2 operating at 20 sps are shown in 
Figs. 32 and 33. Stochastic performance is improved when comparisons are 
made with the 5 sps designs. Throttle activity is smoother and height error 
is relatively flat during the descent. The aircraft response is quicker as 
evidenced by the sharper pitch angle changes. It remains to be determined 
if passengers can detect a difference between the same type of control system 
operating at different rates. 


B. LATERAL DYNAMICS 


The lateral control design responses along the curved trajectory with 
disturbances are shown in Figs. 34, 35 and 36. The steady wind causes the 
aircraft dynamics in the simulation to initially trim the aircraft with a 
nonzero track angle error but with a zero cross track error. The 20 sps 
LAT1 design quickly drives the track angle error to zero. The steady 
wind and gusts have little effect on the excellent simulation performance 
of the LAT1 design at 20 sps. 

The 5 sps design simulations for LAT1 and LAT2 in Figs. 34 and 36 
have a slower response than the 20 sps LAT1 design and develop a larger 
cross track error, (60 m vers. 15 m) . Differences between the 5 sps LAT1 
and 5 sps LAT2 outer- loop control designs are noticeable in the roll response 
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and slideslip response. LAT1 has slightly larger slideslip excursions, 
while LAT2 has a slightly larger roll overshoot. The cross track error 
and track angle error simulations for LAT1 and LAT2 are essentially iden- 
tical. Increasing the cross track error gain in the lateral integrator 
for LAT2 does not reduce the cross track error response in transients. It 
remains to be determined if aircraft passengers can detect differences be- 
tween the two lateral control systems. 

From the simulation runs, it is seen that the overall performance of 
the outer-loop control systems starting from level flight to near the runway 
is satisfactory. The simultaneous lateral and longitudinal maneuvers are 
performed and completed with response consideration given to passenger com- 
fort. There are no detrimental overshoots or oscillations in the presence 
of steady winds and typical levels of atmospheric turbulence. 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


A. Conclusions 


The conclusions of this study are: 

• Outer-loop digital flight control systems can be successfully 
designed and practically implemented using the synthesis theory 
of optimal limited state feedback. 

• Optimal limited state feedback allows a designer to explore a 
variety of control structures and compensation elements in the 
control loop. 

• Integrated control designs, such as L0N3 and LAT1 in the report, 
have superior performance over the nested decentralized approach, 
such as L0N1, for identical quadratic weights. 

• The outer-loop control system can operate at a very slow sample 
rate (5 sps) with reasonable performance and stability margins. 
The performance at the fast rate outer-loop designs (20 sps) is 
better than the slow rate design, as expected, but pilot opinion 
will have to be used to determine if the difference is noticeable 
in flight. 

• The structure used to form the integral error has a significant 
effect on control performance. L0N3 performed better than L0N2 
which performed better than L0N1 for identical cost functions. 

The three longitudinal control systems primarily differed in the 
way the integral error is constructed. 

• The control system in simulation flies the airplane successfully 
through severe wind shears near the terminal area. 

• The gain-scheduled control system stabilizes the airplane in 
simulation for the following individual variations in parameters 
away from the design flight conditions: 


• 3048 m (10,000 ft) to sea level 

• 59 m/s (115 kt) to 154 m/s (300 kt) 

• 0.2 to 0.3 eg 

• 90,000 lb to 75,000 lb 

• throttle saturated either full forward or zero 

• rudder actuator failed 
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• The use of multi-input sigma plot's for relative evaluation of 
control performance was unsatisfactory. A better indication of 
relative control performance was provided by single-loop Bode 
plots. The sigma plots were considered to be too conservative. 

• The control system flies a curved trajectory in the terminal 
area with high accuracy and good response to measurement noise, 
gusts and steady winds. 


B. Recommendations 


• The performance of the lateral control system degrades with bank 
angle, particularly past 35 deg. The maximum bank angle expected 
in flight is 25 deg. Improvements could be made by identifying 
the linear dynamics of the aircraft while the aircraft is banked 
in the nonlinear simulation using readily available parameter 
identification programs. 

• An interesting use of the lateral command system is for the RNAV/ 
MLS transition problem reported in Ref. 8. The position estimate 
of the aircraft changes abruptly when the MLS transmitters are in 
range and the MLS measurements become available to the filters 
onboard the aircraft. The change is caused by the increased accu- 
racy of MLS versus RNAV. When the change is detected, the control 
system can be reinitialized and the command model activated to 
transfer the aircraft to the more highly accurate guidance path . 

• A potentially better approach to gain scheduling is to bring the 
selection of the regression coefficients directly into the control 
design optimization process. ICS has developed an approach using 
stochastic optimal limited state feedback which could perform the 
optimization. 

• Dynamic compensation and eigenvalue sensitivity analysis should 
be incorporated in the cost function. 

• Wind shear accommodation using the command generator tracker 
should be used in the outer-loop control design. 

• The energy probe, Ref. 20, should be investigated as a feedback 
sensor. 

• The design of the inner- and outer-loop should be integrated 
using multirate optimal output feedback theory. 


46 



Appendix A GAIN SCHEDULES 


This appendix presents the regression coefficients for all the control 
system gains. The appendix is a printout of the two FORTRAN subroutines 
used to compute the lateral (LATGAIN) and the longitudinal (LONGSCH) gains. 
LATGAIN and LONGSCH are called by the subroutines PIFLAT. and PIFLON dis- 
cussed in Appendix B. 


A. 1 LATGAIN 


SUBROUTINE LATC*AlN( VGS# 1CHCSLA, GAIN* ) 


C ICHOSU DETERMINES VHICH SCHEOUAL TO USE IN LATGAIN 

C -1 0.05 SEC 1.0PHI ♦ 0.5Y OESIGN 

C - 2 0.20 SFC 1 .0 PHI ♦ 0.5Y DESIGN 

C - 3 0.20 SEC 1 .0 PHI ♦ 1.0Y DESIGN 

C VGS AIRSPEED USED FOR GAIN 5CHFDUAL 

C G A IN A OUTPUT CAIN VFCTOP 

DIMENSION GAINA(l) 

DIMENSION PVL2AUR1,' PCL2AC18J# PVL8A(18), PCL8AU8), 

A PCL2SMB)# PVLPBnftJ# PVL2 R C 1 8 ) # PCL 6B { 1 8 ) » 

R PCL2C<1R), PVL8CC18)# PVL2C(X8>, PCtBCdP) 


C GAIN SET FOR ICHOSLA - X t LAT1 20 SPS 


C A1 


C 


c 


c 


DATA 

PVL2A 

/0. 0000122, 

C. 0001380, 

-0.001690, 

-O.0C1060, 

A 


-0.01530. 

C .00712# 

-G. 05050, 

0.01815# 

e 


-0 • C0C053! , 

0.0003700, 



c 


-0. 00003190, 

-0.00000718, 

-C, 0014610, 

-0.0004200, 

D 


O.C04550, 

0.000231, 

0.10700, 

0.01820/ 

A2 






DATA 

PCL2A 

/O * 92 60, 

-0.02740, 

0.22500, 

1.0003, 

A 


-1.410# 

-1.520, 

0.2380, 

-1*6580, 

B 


-0.166, 

-0.03660, 



C 


0 .003500, 

-0 .000595 , 

C.1340, 

0.01560# 

D 


1.688, 

-0.4790, 

-10.35. 

0.3720/ 

A3 






DATA 

PVL8A 

/0.0C010R60, 

0 • 0000976* 

-0 .001*40, 

-0.00076700# 

A 


0.00512, 

0 * 003 520, 

-0.02620, 

0.01508, 

e 


0.0001219, 

-C.OOOC221, 



C 


0.00001161, 

0.000007CR3,0.0001950, 

0.0001518, 

D 


0.001370, 

C. 000231, 

0.07008, 

-0,002995/ 

A 4 






DATA 

PCL8A 

/0 • 9006, 

-0 .02290, 

C. 16600, 

0.9420, 

A 


-4.90e0# 

-0.P9?O0j 

-3.6430, 

-0,91580# 

B 


-0.20C2, 

0.05237, 



C 


-0.C036800 , 

-0.003103, 

-0.1575, 

-0.09110# 

D 


2 • 1 OX, 

-0.479, 

1.196C0, 

4.6/ 


C GAIN SET FOP ICHOSLA • 2 * I.ATl 5 SPS 

C A1 


DATA PVIL2R /0.CCG0C736 
A -0.00969, 

B -0.000355, 

C -0 .0000418, 

D 0.00431, 


* 0.C00422, -0.00265, 

0.00630, -0.05C9, 

0.000177, 

-0.00000943,-0.00238, 
-0.00428, 0.0864, 


-C.0036R » 
C • 0123, 

- 0 . 00100 , 
C.0164 / 
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C A2 


DATA PCL2R /O # 7026* 
A -1.659 » 
R -C.133 * 
C 0. 00607 
D 1 .617# 


-0.0904 , 
-1.328 * 
0.000876* 
-0.C0394 * 
0.368 , 


0.453 * 

0.431 * 

0.193 * 
-8.573* 


0.969 * 
-0.089 * 

0.00627* 
0.536 / 


C A3 


DATA PVL0P /O. 0002*000* 0.000317 *-C. 00197 * 0.0* 

A 0.C0211* 0.00303 * -0.C345 * 0.00906 * 

P 0.C0005A2, -C .0000412# 

C 0.000C297* 0.C00C33 * C. 0009995* O.CCllO * 

D 0.00262 * O.OOliee* 0.C621 * -0 .000962/ 


C A4 


DATA PCL8B /0.643 * 
A -3.66 * 
B -0.107* 

C -0.00613 
D 1.93 , 


-0.0803 * 
-0.783 * 

C.0426* 
*-0.01185 * 
-0.565 * 


0.319 * 

-2*397 * 

-0.4468* 
0.731 * 


0.30 * 

-C.1A9 * 


-C.A125 * 
3.851 / 


CMMMMUieMIMMffflMMKMfMMMtMMMMimilMlJflMf 


C GAIN SET FOP ICHOSIA • 3 l LAT2 5 SPS 


C A 1 


DATA PVL2C /-.G0006347# 
A -.01454307* 
B -.00026427* 
C — .00006 6C0# 
D .00625027* 


.00052460* 
,00696107* 
• CC027847* 
-.00001620* 
-.00570140* 


-.00445020* 

-.05593540* 

-.00347640* 

.10954627* 


-.00387860# 

.01714920* 

-.00114100# 

.01698967/ 


C A 2 

DATA PCL2C / .71257900* -.10296300* *66837100* .99597300* 

A -l, 367758C0*-1. 42958700* .56022700*-l .56585600* 

B -. 1 5631 2C0*- -.00 579400* 

C .C06P20CC* -.00271400* .27671700* .01472500* 

0 1 • 354252C0* .6799<>2C0#-ll,23503ee* .23233500/ 

C A3 


DATA PVL8C / .00047339* 
A .004C0Q66* 
B -.00019993, 
C .00006924, 
D .00522494* 


.00024057# .00052169* -.00038889* 

.00266535* -.04970220* .00361226* 

-.00017509* 

.00004200* .00274C26* .C01546B2* 

.00236178* .05518012* -.00396304/ 


C A4 


DATA PCL8C 
A 
B 
C 
D 


/ .57379086* 
-4.62242514* 
-.20716400* 
-•PI 6 15143# 
1.37765914, 


-.06181143* -.34302971, .36824171# 

-.66170971,-1.07118800# 1.21282886# 
.08338371* 

-.01326000* -.88210114* -.48773771# 
-.83018829, 3.63572686* 4.10506943/ 


C ICHOSLA - 1 

IF( ICHOSLA .HE. 1 ) GO TO 30 

I F ( VGS .GE. 180. J GO TO 15 

C VGS IS LESS THAN 180.0 
00 10 1-1*18 

G A 1NA ( I ) - P VL2A ( I ) ♦ VGS ♦ PCL2A(I) 
10 CONTINUE 

GO TO 100 

C VGS IS GREATER THAN 180.0 
15 CONTINUE 

DO 20 1-1*18 

GAINAU) • PVL8ACI) ♦ VGS ♦ PCL8A ( I) 
20 CONTINUE 

GO TO 100 
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C ICHOSLA - 2 


30 CONTINUE 

IEt ICHOSLA .NE* 2 1 GO TO 70 

IFt VGS .GE. 180. ) GO TO 50 

C VGS 1$ LESS THAN 180.0 

DO 40 I • 1,18 

GAINMI) ■ P VL28 ( I ) ♦VGS ♦ PCL2eC!) 

*0 CONTINUE 

GO TO 100 

50 CONTINUE 

C VGS IS GREATER THAN 180.0 

00 60 I • 1 # 1 8 

GAINACII ■ PVLBB(I)*VGS 4 PCL8B(n 
80 CONTINUE 

GO TO 100 

C ICHOSLA • 3 (DATA FROM IATDAT1 - 9/22/82 BROUSSARD'S ACCOUNT ♦♦ ) 

70 CONTINUE 

IF ( ICHOSLA .NE. 3 ) GO TO 90 
I F C VGS .GE. 180 ) GO TO 80 
C VGS IS LESS THAN 180.0 

on 75 I • 1,18 

GAINA(I) . PVL2C ( I ) *VG$ 4 PCL2C(IJ 
75 CONTINUE 

GO TO 100 

80 CONTINUE 

C VGS IS GREATER THAN 1G0.0 

00 85 I - 1,18 

GAINA(I) - PVL8C(I)*VGS 4 PCL8C(I) 

85 CONTINUE 

GO TO 100 


90 CONTINUE 


EPP0P IN LATGAIN “ ICHOSLA - ", ICHOSLA," THIS IS NOT AN 

A PT I UN " 

STOP * ERR OR IN LATGATN NT OPTION ICHOSLA" 

100 CONTINUE 

RETURN 

END 


A. 2 LONGS CH 


c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE 10NGSCH( VGS, ICHOSLO, GAINA ) 


ICHOSLO 


GAINA 


— — DETEPN JNFS VHICH SCHFDUAL TD 

USE IN LONCSCH 


■ 1 nested 

O.f-5 SFC 

1.07 

♦ 

0.17DOT DESIGN 


• 2 NFSTFD 

C • 20 SEC 

1.07 

♦ 

0.17D0T DFSIGN 


■ 3 COUPLED 

0.20 SEC 

1.C7 

4 

2ozrnT ♦ 0.1V2 

OESIGN 

• 4 COUP l EO 

o.eo src 

1.C7 

4 

20ZP0T 4 1.0V2 

DESIGN 

• 5 COUPLED 

0.20 SEC 

l.oz 

4 

I 07 DOT DESIGN 

• 6 COUPLED 
AIRSPEED USED 

0.05 SEC 
FOR GAIN 

1.02 ♦ 
SCHEDUAL 

10ZD0T DESIGN 



OUTPUT GAIN VECTOR 



omnsio* 

DIMENSION 

A 

B 

C 

D 

E 


GA IN A ( 1 ) 
PV102A(22)# 
PVL 02C < 22 ) # 
PVLC2nC22># 
PVLOZli?.?), 
PVL02F ( 22 ) # 
PVLQ2G (2? ) # 


PVIOPA122)# 
PVLPK (22)# 

pvireo( 22 ># 

PVLC p F 1 22 ) # 
PVin*F(22)# 
PVL06G(22 )# 


PCL02 A (22 ) # 
PCLP2C 1221# 
PC102D(2?J# 
PCL02F<22)# 
PCLC2F (22 ) » 
PC L02G ( 22 ) # 


PCI 08 A (22 )# 
PCLOflC (22)# 
PC 1 08DC22 I# 
PCL08E ( 22 ) # 
PCtOeF(22)# 
PCL08GC22) 


C GAIN SET FOR ICHOSLO ■ 1 I LONl 20 SPS 
C AI 


DATA 

PVL02A/-0. 000000# 

o.ooocooo# 

0.000000# 

0.0001570# 

A 

0.0000386# 

-C. 000000# 

-0.00570# 

0.000000# 

8 

-0.00000# 

0.00826# 

-O.OOCOOO# 

0.0020600# 

C 

-O.OCOOO# 

0.002430# 



D 

-o.oooooco# 

0.00002348# 

O.OOOCOCOO# 

0.0000000# 

E 

-o.oooooc# 

O.COOCOO# 

-0.000000# 

-0.000000/ 

A2 





DATA 

PCL02A/ 0.970# 

-O.COOOO# 

-0.00000# 

0.901# 

A 

-0.41P0# 

-0.0000# 

1.7240# 

7.520# 

B 

-0.000000# 

-2.290CO0# 

0.00000# 

-0.4930# 

C 

-O.COOO# 

-0.520300# 



0 

O.OCOOO# 

-C. 004740# 

-0.000544, 

-0.00000# 

E 

-0.0000# 

1.1G0C# 

0.1800# 

0.000/ 


C A3 

DATA PVL08A/ 0.0000000# 0.0# 0.0# 0.0002390# 

A -0.0C0449# -0.000000# 0. 04160# 0.0157# 

B C. 000000# 0.00569# O.OOOCO# 0.00000# 

C 0.0# 0.00466# 

D 0. 0000000#“0. 00000889# O.OOCOOOO# O.OOOOCOO# 


E 

0.00000# 

-0.012000# 

-0.000476# 

0.000000/ 

A4 





DATA 

PCL08A/ 0.9690# 

0.0# 

0.000# 

0.896# 

A 

-0.3190# 

c.cooo# 

-2.523# 

4.326# 

B 

-0.000# 

-1.609# 

-0.0000# 

-0.463# 

C 

O.OC# 

-2.135# 



D 

0.00000# 

0.0004466# 

-0.00108C# 

-0.000000# 

E 

-0.00# 

1.63# 

0.304# 

0.000/ 


C GAIN SET FOR ICHOSLO • 2 I LCN1 3 SPS 

C Al 


OATA 

P VL02C / O.CC0181# 

o.ooocooo# 

0.000000# 

0.0011900# 

A 

—0 .000034 8# 

-o.ooocoo# 

-0.00533# 

0.009140# 

B 

-O.OCOOO# 

C. 00675# 

-O.OOOCOO# 

0.0003610# 

C 

-o.oooon# 

C. 002235# 



D 

-O.OOCOOOO# 

0* C0PC1170# 

-0.00001160# 

0.0000000# 

E 

-0.000000# 

c.cooooo# 

-0.000000# 

-0.000000/ 

A2 





DATA 

PCL02C / O.P3POOO# 

o.ooocooo# 

O.OOOOOC# 

0 • 5330000# 

A 

-0 • 44 300CO# 

-O.COOCOO# 

1.586C0# 

6.030000# 

8 

-0.00000* 

-2.243C0# 

-0.000000# 

-0.2040000# 

C 

-O.OOOCO# 

-0 • 30PCOO# 



D 

-o.ococooo# 

-0 .00505000# 

-0.00046400# 

0.0000000# 

E 

-O.OGOOOO# 

1.10C000# 

C.1P0C00# 

-0.000000/ 

A3 





DATA 

PV108C/ 0.0000772# 

0.0# 

0.0# 

0.0005280# 

A 

-0.000179# 

-O.OOOCOO# 

0.04P20# 

0.0311# 

8 

o.ococoo# 

0.00317# 

C.OOOCO# 

-0.00175# 

C 

0.0# 

0.002354# 



D 

0.000000# 

-C. 00003910# 

0.00000352# 

0.0000000# 

E 

o.ooooo# 

-0.013100# 

-O.OOC476# 

0.000000/ 
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C A4 


DATA PCL08C/ 0.0720000, O.O, 

A -0.343000, -O.OOOCOO, 

6 Q.OGOOOC, -1.249CC, 

C 0.0, -1.594000, 

0 O.OOOCOCO, 0.00256000, 


0 . 0 , 

-4.58000, 

0 . 00000 , 

-0.00*69000, 


E 


0.00000, 4.530000, 0.304000, 


C 


C GAIN SET FOR ICHOSLO • 3 * L0N3 5 SPS 


C A1 


DATA PVL02D 
A 
B 
C 
D 
E 


t .0C0CP400, 
.00236*67, 
-.001*5333, 
-.00220600, 
-.00000624, 
.006S3267, 


.00003*00, 
-.00530533, 
•0075c?67, 
. 00002600, 
-.00000299, 
-.003*9067, 


• 00002733, 
.00*11267, 
-.00060600, 

-.00000367, 

-.00197333, 


C A2 


DATA 

A 

B 

C 

D 

l 


PCL02D 


/ .66*93000, .011*3000, 

- • 6 6279C00, 1.05291000, 
.26415000,-2.32136000, 
.*4569000, -.67069000, 
.00169770, -.00221090, 

— 1 .69338000, 1.95067000, 


-.00527000, 
- • 73 5 03 CCO, 
.13333000, 

-.00199250, 

.70090000, 


C A3 


DATA PVLOeD 

A 

c 

D 

E 


/-• 00007876, 
-.00060886, 
.00021933, 
.00047057, 
•0C0C0225, 
.00672657, 


-.00015695, 

-.00243019, 

.00226229, 

.0003511*, 

. 00000122 , 

.00107133, 


.000169*3, 

.10392314, 

-.00035238, 

-.00000192, 

-.00010324, 


C A4 


DATA 

A 

8 

C 

D 

E 


PCL08D / .89456857, .06116571, -.01910657, 

-.22378286, .75389714,-14 . 8256C 29,- 

-.09696000,-1 .57896571, .07461429, 

-.00229143, -.73556286, 

-.00029669, -.00265320, -.00263177, 
-1.35965143, 1.24962000, .46065143, 


C GAIN SET FDR ICHOSLO • 4 (NOT DISCUSSED IN REPORT) 


DATA 

PVL02E 

/-. 00002733, 

.00005200, 

-.00000*00, 

A 


.00006600, 

—.01041133, 

.00525333, 

e 


-.00155067, 

.008*3533, 

-.000*1533, 

c 


-.00111467, 

.00046200, 


p 


-.00000663, 

•00000080, 

-.00000095, 

E 


.00701200, 

-.0046*533, 

-.00133133, 

OATA 

PCL02E 

/ .88727000, 

.00604000, 

-.00318000, 

A 


-.42214CC0, 

1.37354000, 

-.86895000, 

B 


.2631700 C,- 

-2.53511C0C, 

.098*6000, 

C 


.17209000, 

-.71646000, 


D 


.00101480, 

-.00288*50, 

-.00255*60, 

E 


-1.70516000, 

2 .29066000, 

• 51P99C00, 

OATA 

PVLOEE 

/-. 00006305, 

-.00051724, 

-.00008171, 

A 


-.00074000, 

-.0CC B P6*6, 

.106501*3, 

6 


-.00063447, 

-.00075200, 

—.00038152, 

C 


.0004ei71, 

—.00033286, 


D 


.00000590, 

- . O0C0O2* 5, 

-.00000360, 

E 


.0067231*, 

.00107562, 

-.00010152, 

OATA 

PCL08E 

/ .89575429, 

•1602 C 143, 

.05037*29, 

A 


—.1 *750000, 

.32680286,* 

-15.538Q2P6, 

8 


.13925800, 

-.74778000, 

.08267714, 

C 


-.00537*29, 

-.5463*286, 


0 


-.0013065*, 

-.00*183823, 

-.00216697, 

E 


-1.35890286, 

1.24863*29, 

.46017714, 


0.6160000, 

0.4740, 

0.01130, 

0 . 0000000 , 


0 . 000000 / 


.00061533, 

.00540533, 

.00004000, 

•00002056, 

.00491667/ 


.57369000, 

6.403590b0, 

-.09770000, 

-.00366680, 

1.15e25000/ 


-.00007333, 

.06879019, 

•00001248, 

. O0COOO57, 
-.00049171/ 


.69970000, 

5.84469714, 

-.10176266, 

-.00020897, 

.22197429/ 


.00061733, 

.00573133, 

.00026867, 


.00002026, 

-.00690200/ 

• 56533COO 
6.91521000, 
-.14091000, 

-.00272680, 

1.72696000/ 

-.00078905, 

.03509333, 

•00029362, 

•00001938, 

-.00049000/ 

.89771429, 
3.47790000, 
— . 1795457J, 

-.00541426, 

.22150000/ 
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c 


C GAIN SET FOR ICHOSIO • 5 I lON2 5 SPS 


C AX 


DATA PVL02F 
A 
B 
C 
0 
E 


/ .00006333# 
.00222933# 
-.00226730, 
-.00142000# 
-.00001061# 
.00792133# 


.00008267# 

-•0C410133# 

.00613667# 

•00C276C0# 

-.00C00795# 

-.00523200# 


.00006267# 
.00507533# 
-.00067200# - 

-.0000064*, 
-.00238667# - 


C A2 


DATA PCL02F 
A 
B 
C 
D 
E 


/ .86825000# -.00038C00# -.01728000# 
-.86933000# .90229000#-!. 0711 6000# 6 

•42792000#-2.435C5G00» .19546C00# - 

.28365000# -.3*593000# 

.00222270# -.00139840# -.0014Q530# - 
-1.09854000# 2.14566000# .74386000# 1 


C A3 


DATA PVL08F 
A 
B 
C 
D 
E 


/-. 00008010# 
— • 00044C00# 
.00009943# 
.00073933# 
.00000*41# 
• 0C6C1571# 


-.00009010# 

-.00171990# 

.00169629# 

-.00005619# 

-.00000008# 

•00089181# 


.00019162# 

.10039133# 

.00034543# 

•000C0232# 

.00038095# 


C A4 


DATA PCL08F 
A 
8 
C 
0 
E 


/ .89394 6 57# .03774857# -.02512571# 

— • 27210C00# .6399514 3 #-14. 1126600#-; 
-.056 106 57,-1. 4*5760571# .060966 57# - 

-.0P546C00# -.31374256# 

-.C00636P3# -.00262969# -.00256974# 
-1.19761429, 1.04407714, .52878571# 


CMtfMfMMtMMMMMMMffMMMlfMMf 

C GUN SET FOR ICHOSIO • 6 I IDN2 20 SPS 


C AX 

.00002733# 
.00467000# 
.00089133# 

.00000162# 
.00262467# 

C A2 


DATA PVL02G 
A 
B 
C 
0 
E 


/ .00001333# 
•0C1 53333# 
-.00215133# 
-.00144667# 
-.00000273# 
.00052133# 


.00001933# 
-.00438067, 
.00858800# - 
.00025400# 
-.00C00191, - 
-.00713067# - 


DATA PCL02G 
A 
B 
C 
0 
E 


/ .96690000# .00012000# 

-.79025000# • 96 5 57C00# 

.40574000,-2.56514000# 
.28940000# -.37767000# 
.00056630# -.00043060# 
-2.01369000# 2.58562000# 


-.00592000# 

-.96175000# 

♦19944C00# 

-.00039690, 

.79524000# 


C A3 


OATA PVL086 
A 
B 
C 
D 
E 


00002486# 

-.00054686# 

.00024276# 

.00066724# 

.00000138# 

.00613810# 


-.00002257# 

-.00170240, 

.00053686# 

.00007190# 

-.00000020# 

.00115895# 


.00009362# 

.10309933# 

-.00031924# 

— • 000C0C73# 
-.00034952# 


C A4 


DATA 

A 

B 

C 

D 

E 


PCLO0G / .97347714# .00991143# -.01844571# 

-.26510286# .68076286#— 14 .4408599#- 

— .084C0P57#-1. 33629714, .07681143# 

-.07069143# -.36007143# 

-.00021423# -.00069954# -.00064446# 
-1.22052857# 1.11313429# .53945714# 


•00072600# 

.00824400# 

•00014200# 

•00002184# 

•01026000/ 


•56062000# 

.13488000# 

.10319000# 

.00442770# 

.98925000/ 


.00017390# 

.050109X4# 

.0000X905# 

•00000146# 

.00088762/ 


.74529143# 

.39336266# 

.12781429# 

>•00057054# 

.28488571/ 


.00010933# 

.00692733# 

.00011333# 

.00000599# 

.00643600/ 


.69397000# 

6.96782000# 

.11945000# 

•00120830# 

-.01184000/ 


-.00009905# 

.05867806# 

-.00001476# 

•00000036# 

-.00095581/ 


.94571429# 

3.34991714# 

-.13307143# 

-.00014134# 

.30436266/ 
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C ICHOSLO - I 

IF t ICHOSLO .HE. 1 ) GO TO SO 

I F C VGS .GE. 180* ) GO TO 13 

DO 10 I • 1# 22 

GAINA(I) - P VL02A ( I ) ♦VGS 4 PCL02ACI) 

10 CONTINUE 

GO TO 200 

13 CONTINUE 

DO 20 I ■ 1,22 

GAINA(I) - FVL08AC I MVGS 4 PCL08A C I ) 

20 CONTINUE 

GO TO 200 

C ICHOSLO • 2 
30 CONTINUE 

IFC ICHOSLO .HE. 2 ) GO TO 50 

I F C VGS .GE. 180. ) GO TO 40 

DO 35 I • 1,22 

GAINAM) • PVL02C ( I )*VG$ 4 PCL02CCI) 

35 CONTINUE 

GO TO 200 

40 CONTINUE 

DO 45 I - 1,22 

gajna(I) • PVLoec(i)*vGS 4 pcioecm 
45 CONTINUE 

GO TO 200 

C ICHOSLO - 3 (DATA FRON L0NDAT1 - 9/22/82 **J. BROUSSARD* 5 ACCOUNT**) 
30 CONTINUE 

IF ( ICHOSLO .HE. 3 ) GO TO 70 

IFC VGS .GE. ISO. ) GO TO 60 

DO 33 I • 1,22 

GAINA(I) • PVl020<n*VGS 4 PCL02D!I) 

55 CONTINUE 

GO TO 200 

60 CONTINUE 

DO 65 I • 1,22 

GAINAdi • PVLC9D ( I )*VGS ♦ PCtOBD(I) 

65 CONTINUE 

GO TO 200 

C ICHOSLO • 4 (DATA FROM LONOAT2 - 9/22/82 **J. BROUSSARD*S ACCOUNT**) 
70 CONTINUE 

IF ( ICHOSLO .NE. 4 ) 60 TO 90 

IFC VGS .GE. 180. ) GO TO 80 

DO 75 I • 1,22 

GAINA(I) - PVL 02 E ( I ) * VGS ♦ PCL02ECI) 

75 CONTINUE 

GO TO 200 

80 CONTINUE 

DO 85 I • 1,22 

GA1NACI) • PVL08E ( I ) *VGS 4 PCL08E (I ) 

85 CONTINUE 

GO TO 200 

C ICHOSLO - 3 (DATA FROM L0NDAT3 - 9/22/82 **J. BR0US5ARD*S ACCOUNT**) 
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90 CONTINUE 


IF C ICHOSLO .HE. 5 ) 60 TO 110 
IF C VGS .GE. 180, ) GO TO 100 


DO 95 I • 1,22 

GAIN A ( I ) • P VL02F ( I ) *VG$ ♦ PCLP2FCI) 

95 CONTINUE 

GO TO 200 

100 CONTINUE 

00 105 I • 1,22 

GAINACI) • PVL08F f I )*VGS ♦ PCL08FCI) 

105 CONTINUE 

GO TO 200 

C ICHOSLO - 6 (DATA FROH LDNDAT* - 9/22/82 **J. *RCUSSARD»S ACCOUNT**) 
110 CONTINUE 

IF C ICHOSLO .NE. 6 ) GO TO 150 

IF C VGS ,GE. 180, > GO TO 120 

OP 115 I • 1,22 

GAINA(I) - PVL02GU)*VGS ♦ PCL02GII) 

115 CONTINUE 

GO TO 200 

120 CONTINUE 

00 125 I • 1,22 

GAINACI) • PVL08GC I ) *VGS ♦ PCL08CCI) 

125 CONTINUE 

GO TO 200 


150 CONTINUE 


PRINT *,• ERRflR IN 10NGSCH - ICHOSLO • ",IChPS10,» THIS IS NOT AN 
APTIPN* 

STOP "ERROR IN LPNGSCH NT OPTION ICHOSLO* 

2C0 CONTINUE 


RETURN 

END 


54 


Appendix B LONGITUDINAL AND LATERAL SOFTWARE 


This appendix presents the FORTRAN listing of the subroutines PIFLON 
and PIFLAT. The subroutines are called 20 times per second during the 
nonlinear simulations in Chapters IV and VI. 

B. 1 PIFLAT 


si'flpnurrNF piflat( oacmd, drcho, phk, bnkpar# cpte, 


A TAGF# CA$# VfS, DAM, DPM, 

R PHI DO T, KV# T* ICHflSlA, MM A 

C PntlMAK, ROLLMAX, NMULATI# OFCPl, PCCMAJ, 

D PE BUGA ) 

C DACM[) COMMAND AILERON - DEG 

C DPCMO COMHANL PUCDFh - DFG 

C RNK BANK ANGIE - DEG 

C PNKBAP COMMAND BANK ANGIE - DFG 

C CP TB CROSS TRACK ANGIE - FEET 

C TAG c TRAC* ANGLE EPPOP - DFG 

C CAS CALIBRATED AIRSPEED - KT 

C VG$ GROUND SPEFO - FT/SEC 

C DAM MEASURED AILERON - DFG 

C pPM MEASURED R UDDER - DFG 

C PHIOQT N £ A $ M D F D POLL RATE - DEG/SEC 

G KV FIFVATOP CAS SCHEDULED GAIN 

C T SAMPl E TIME - SEC 

C ICHOSLA • 1 CELT * 0.05/ GKY ■ 0.5 

C . 2 PELT • 0.20# GKY - 0.5 

C • 3 Of l T - 0 . 20 # GKY - 1.0 

C HM A X T P I P POINT IN FFET FOP WHEN CONVERSION OCCURS FOR 

C RNAV TC MLS SWITCH CRTE (START WITH ■ 100.0 ) 

C POLIHAK MAXIMUM POLL ANGLE - DEG 

f POILMAX MAXIMUM ROLL ANGLE IF FINDPM IS FALSE 

C r-EGPl max COMMANDED ROLL RATE OF CHANGE - PEG/ Sf C 

C RDCMA1 MAX ROIL PATF OF CHANGE IN COMMAND MODEL - DEG/SFC 

C NhULATI NUMBER OF 0.05 SEC PERIOD DELAYS BETVFEN RECEIVING 

C MEASUPfMFNTS AND RELEASING CONTROL COMMANDS TO ACT 

C IF DFLT-.20 AND NMl/LATI-1# DEL * Y»R FGUL AR 1 PERICO 

C DELAY 

C IF OELT*. 20 AND N M UL AT 1*2/ DEL A Y-REGUL AR 2 PfRICD 

C DELAY 

C IF DELT-.20 AND NMUL ATI • 3/ DELAY-REGULAR 3 PCRICD 

C OELAY 

C IF DFL T» . 20 AND NMILATI-*, DELAY-REGULAR A PERICO 

C DELAY 

C IF DFLT • .05 THEN NMUlATI MUST • 1 

C DE8UGA - .TRUE. — DEBUG PRINTOUT PEOUF.STED 

DIMENSION PGLM18 )/ GA INA (16) 

REAL KV/ KPHIDOT 

LOGICAL FIRST# NOPROP, FINDRM, OEBUGA 

EQUIVALENCE (PGL A Cl), S31 1 ), (PGLA(2),S312), 

A ( PGL A(3),S313), ( PGL A( <»> , S3H ) , 

B (PCLA(5),S3?n# (PGL A(6) #S322 ), 

C ( PGL A ( 7 ), S323 ), ( PGL A ( 8 ) / S 32 A ) / 

F (PGLA<<n,S325>, (PGLA(10),S326I, 

0 (PGIAC11 ) / S411 )/ t PGL At 12 ) , S41 2 I , 

E (PGL A (l?l,$*13), (PGLA(lA),Sm>, 

F (PGL A (15), S421 ), ( PGL A ( 16 > , $*22 ), 

C* (PGLA(17)#SA23), < PGL A< 16 ), SA20 


DATA FIRST /.TRUE. / 
5 CONTINUE 
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IF( .NOT. FIRST ) GO TO 10 


C INITIALIZE STATES 

C CHOOSE CELT AND GKY 
DELT » 0.2 

IM ICHOSIA .EO. 1 ) OfLT ■ .05 
CKY « .5 

IF( ICHOSLA .EO. 3 ) GKY ■ 1, 

C INITIALIZE GAINS 

CASG ■ CAS 

IF< CASG .IT. 120. ) CASG ■ 120. 

IF( CASG ,GT, 300. ) CASG ■ 300. 
CALL lATGUNt CASG# ICHQSIA# PGIA ) 

C SET UP INITIAL VALUES 


ARY 

- .03 



ARP 

• 1.15 



PP 

• ieo. 



PP2 

• 360. 



GRAY 

• 32.17* 



PRO 

• 0.017*532925 

DACHAX 

- 20. 



DR^MAX 

• 30. 



P0LL1 

- POLLO 

■ 

BNK 

ITIME 

■ 0 



TAGE1 

« TAGEO 

■ 

TAGE 

CRTfl 

■ CPTEO 

■ 

CRTE 

P01LN1 

• ENKBAR 



CASS 

' CAS 



DRC 

• DR 1 

• 

OPO 

DAI 

- DAO 

■ 

DAM 

VDA2 

• VDA1 

■ 

0.0 

VDP? 

- VDR1 

■ 

0.0 


C INITIAL Z E MODEL STATES 

Y1 - CRTE 

PSI1 - TAGE 
PHI 1 • BNK 

C INITIALZE INNER LOOP STATES 

PHIOOTF - PHIOOT 
Cl ■ EXP(-2C.0*T) 

KPHIDOT ■ -1.5 

C INITIALZE OTHER OATA 

C NOPROP MODEL INDICATES IF TRUE THAT COMMAND NOT EE PROPAGATED 

C 

C FINDPM FINDS THE MAXIMUM POLL ANGLE FOR CAPTURES 

NOPPOP • .FALSE. 

FINDPM . . TRUF • 

IF< ABS(CPTE) .LT. 3000.0 ) FINDRM . .FALSE. 

I F ( A PS (TAGE ) .IT. 30.0 ) FINDPM ■ .FALSE. 

ILCOP • -1 

FIRST • .FALSE. 

MLOOP • l.O/OELT ♦ 0.1 

MULTI • DELT/T ♦ 0.1 

ACAS - EXP(-2.0*tELT) 

BCAS - 1.0-ACAS 

GFE60 - BCAS 

IMULTI • MULTI -1 

I r C MULTI .FO. 1 )NMULATI ■ 1 
DFGPS • DEGP3 *DELT 
ROCMAX « PDCMA1PDELT 

10 CONTINUE 

C INNER LOOP CALCULATIONS 

PHIOOTF • Cl* ( PHIDOTF - PHIDOT) * PHIDOT 
X - PHIOOTF*KPHIDOT 

C CHECK FOR LOOP ITERATION OF CONTPOL LOOP 
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IF< IMULTI • GE • MULTI ) IMULTI ■ 0 

IHULTI - IMULTI 4 1 

IP C IMULTI *NE • MULTI ) GO TO 65 

POLLNO • ROHM 

PNKE » PNKBAR - ROLLM 


C LIMIT RATE OF CHANGE OF ROLLN TO 5DEG/SEC 

I F < ABS(BNKF) .GT. DEGPS ) BNKE ■ SIGN (1 ,0/ BNKE ) ♦OFGP$ 

POILN1 • RPLLN1 4 BNKE 

C FILTER CAS 

CASS - ACA$*CASS 4 BC AS*C AS 

C UPDATE GAINS EVERY 1.0 SECONDS 

IF f I L OOP .GT. MLO0P ) HOOP • -1 
I LOOP • ILGOP 4 1 
IF< I LOO P .N F • 0 ) GO TO 30 
CASF • CASS 

C UPDATE CROSS AXIS GAIN 

IF< CASF .GT. 300.0 ) CASF • 300.0 

IF ( CASF .IT. 150.0 1 CASF • 150.0 

IF f CASF .GT. 240.0 > GO TO 20 
AK • 0.00016042? *CA$F - 0.05042 

GO TO 25 

20 CONTINUE 

AK ■ 0.000070<36<J34CASF - 0*02694 

C CONSTRUCT GAINS G1-G18 

25 CONTINUE 

CA5G • CASS 

IFf CASG .GT. 300.0 ) CASG • 300.0 

1FI CASG .LT. 120.0 » CASG ■ 120.0 

C CONSTRUCT THE LAT GAINS 

CALL LATGAIN ( CASG/ ICHOSLA, GAINA ) 

ATJKE - ITIMF/100 

NTIME • ATI*E*100 

I F ( NTIME .EO. ITIME ) WR ITE ( 6/ 1C00) ( 1/ PGL A ( I ) / I -1 » 18 ) 

C PROPAGATE CONK AND M00FL 
30 CONTINUE 

I F ( NOPP0P ) GO TO 40 

I F { ABS(Yl) .LT.0.1 .ANO. ABS t PSI 1 ) .LT . 0. 01 ) NOPROP * .TRUE. 

B • GPAV/VGS 

AK 1 • ARY/(MUITI*MULTI> 

A K2 • ARP*VG$/150. O/MULTI 

YO - Y1 

PSIO - PSI1 

PHIO - PH 1 1 

PH 1 1 - -AK1*Y0 - AK2*P$I0 

RDC ■ PH I 1 - PHIO 

UM ■ RDC 

C DO NOT CHANGE HEADING IF ON PATH TO GL IDESLCPE 

IF ( PHI1MPSI1) .GT. 0.0 .AND. ABSfPSIl) .GT. 30.0 ) PDC ■ 0.0 

C FIND MAXIMUM ROLL IF FAR FROM TRACK 

I F ( .NOT. FINDPN ) GO TO 35 

ANUM « (VGS )*(VG5>*(CCS(TAGE4RPD)-1.0 ) 

ATEN - -ICRTE-SIGNU.C/CRTE >*2000.0 >*GftAV 
ADEN « SIGNC1.0. A0EN)*O. 00001 4 ADEN 
POLINA)* - ABS < ATAN?( ANL?H/ ADEN) FRPO) 

I F I ROllMAX .GT, ROHM* ) RPLLMAX • RCLLMAK 

I F C UM* ( PHIO 4 SJGNU.O/PHIOHO. 00001) .LT. OiO ) F INORM- .FALSE . 

35 CONTINUE 
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OOllMAl ■ AMAXl(POLLMAX,APS(BNK&AR)) 

I F ( ABStPHIO ) *GE • POLLMA1 ) RDC • 0.0 

IF ( UMMPHIO ♦ SIGN(1.0#PHJ0)*O. 00001) .IT. 0.0 ) RDC ■ UH 

C APPLY CONTROL IF DECELERATION IS APPLICABLE 

IF ( ABS(RDC) .GE, RDC NAY ) ROC ■ $ IGNI1.0* RDC )*PDCHAX 
PHI 1 • PHIO ♦ RDC 

PSI1 ■ PSIO ♦ nELT*P*TAN(RPD*PHIl)/RPO 

IF < PSI1 .GT. PP ) PSI1 ■ PSI1 - RP2 
I F ( PSU .LT. -PR ) PSU • PSI1 + PP2 

Yl • YO ♦ OFLT*VGS*SIN(RPC*PSIO) ♦ DEIT*0ELT*B*TAN(RPD*PHI1)* 

A 0.5*VG$ 

A ■ P0LLN1 - POLLNO +(PHI1 - PHIO) 

C - POLLNO ♦ PHIO + GKYMCRTE1 - YO) 

gi » psii - psio 

IF C Gl .GT. PP ) Gl - Gl - PP2 
IF ( Gl .LT. -PP ) Gl • Gl ♦ PP2 
G2 ■ TAGEO - TAGE1 

G • G2 - Gl 

H • CRTEO - CRTEl -(Yl - YO ) 

GO TO 50 


AO CONTINUE 

A • ROLLNl - ROUND 

C ■ ROLLNO ♦ GKY*CPTE1 

G • TAGEO - TAGE1 

IF I G .GT. PP) G ■ G - PP2 
IF C G .LT. -PP) G * G ♦ PP2 
H • CRTEO - CRTEl 


50 CONTINUE 

s ■ 0.0 

0 - R0LL1 - C 

E ■ DR 1 — AK+C - ORC 

F • PniLO - R0LL1 

C DETERMINE IF THERE HAS PEEK A LARGE CHANGE IN CRTE CAUSEO BY 
C CHANGING FROM RNAV TO MLS 

I F ( ABS(H) .LT. HMAX ) GO TO 55 
FIRST • .TRUE. 

GO TO 5 

55 CONTINUE 

C EASYON HERE 

DO 60 I • 1*1P 

PGLA(I) • PGLA(I) ♦ GFEEDMGAmm - PGLAU)) 

60 CONTINUE 

C COMPUTE CONTROL LAW 


VDA1 

1 

2 

3 

VDR1 

1 

2 

3 


$311*VDA2 ♦ S31 3* VDR2 ♦ 

S3 21* F ♦ S323*G ♦ S325*H ♦ 

S A 1 1*D * S A 1 3* E ♦ 

S A 2 1 * A * SA23*P 

S 3 1 2* VDA 2 ♦ S31 A*VDR2 ♦ 

S 3 22* F ♦ S32**G + S326*H ♦ 

SA12*D ♦ SA1 A*E * 

S A2 2* A * S A2 A* B 


PAO - DAI ♦ DEL T*V0A1 

ORO - DR 1 ♦ 0ELT*VDR1 


IF (I LOOP . N 6 • 0 ) GO TO 65 


C TIME CHECK 


DPTIH • SECONDCCP) 


C PRINT OUTPUT FOR DEBUG 

I F « .NOT. OEBUGA ) GO TO 65 
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B. 2 PIFLON 


WRITE C 6# 2000) PHI 1# ROLLNO# Yl# CPTF# P$U# NMULATI# 
A DPTIM# IHUtTI, MULTI# N L00 p 

C WRITE (6*3000) A # 8# C# Op E# F# G» H# DACMO# DRCHO 

65 CONTINUE 

IF( IMULTI .NE. NMULATI ) GO TO 70 
C DOWNLOAD DATA 


R0LL1 

■ ROILO 


ROLLO 

• BNK 


TAGE1 

» TAGEO 


TAGEO 

« TAGE 


CRTEl 

- CRTEO 


CRTEO 

- CRTE 


CONTINUE 


PACMO 

■ KVMDAO ♦ XI 


PRCMD 

■ DRO 


5 DCESS 

CONTROL COMMANDS FOP CONTROL 

LIMITS 

IF ( ARS(DACPP) • LT » DACMAX I GO TO 73 

DACMD 

• SIGN(l.O#OACMO)*DACMAX 


DAO 

■ (OACPD/KV) - X 


VDAI 

• 0.0 


CONTINUE 


VDA2 

- V0A1 


0 A 1 

» 0 AO 


IF C ABS(OPCND) .IT. DRCMAX I GO TO 

60 

PRCMD 

■ SIGNd.O#DRCMD)*DRCMAX 


V0R1 

■ 0.0 


DRO 

• ORCMD 


CONTINUE 


VDR2 

• VDRI 


DR 1 

• DRO 


ITIME 

• ITIHE ♦ 1 


format 

STATEMENTS 



10CC FQPMATdX#/#lX#MI3#Fl5,8)#/#lX#6(I3#F13«8I# 

A /»1X#6(T3#F15.8)»/#1X#6( I3#Fl5.m 

2000 FQRMATdX# "PHI1 ROLLNO Y1 CRETE PSI1 

A 5(2X,F1G.5)#/#1X# 

A "DPTIM NMULATI INULTI MULTI NLCO* 

A 1(2X#F1C.5)#M2X#I10 ) ) 


3000 FOR MAT d X> "A B 

t 5(2X,P10.5)#/#1X# 

C 

D 

E 

A "F G 

A 5<2X#F10.5I) 

H 

OACMO 

ORCMD 


M 


P 


RETURN 

END 


SUBROUTINE PIFLON< 
A 
I 
C 
D 
F 
F 


DFCMD# 
ROLL # 

0# HCVP# 

OEM, Ft A PC/ 

ICHCSLO# rMAX, 
ANA70# D7MAX2# 
CASMA1# DD7NA1# 


OTCHD# 

FPR, 


PITCH# TAS# 
ZBARO# HVSI# 
HOC WP# CASWP# 

KV# T, 

FLAPON, 7FILT# 
AOAMAX, AOAMIN# 
A02EP1# DEBUGO 


CAS# 

ACC# 

DTK, 

KTOFPS# 

AMAZ# 

NNULOTI# 

) 



o n n n r» o Oft on noooooooooooooooooooooonomoooonooooono 


PITCH— 

T If 



— KEASURFO PITCH ANI 

;le 


• 

DEG 






— iRUfc AIRSPEED 




r T f 5tv 



C * 5 



v*Linrf#icu flirgrccu 



XT 



F PR — 



— ENGINE PRESSURE RATIO 



DEG 



ROLL — 



—measured ROLL ANGLE 








DBuuDu?rcru 




rl/Jtt 






— BAROMETRIC HEIGHT 
—VERTICAL VELOCITY 

Fc A 5 UR fc FIE NT 



FT 


Ur 




MEASUREMENT 



FT/SEC**2 


Ur 

Alt — 



"»5M K*L AltClr'AI lUn rrA'UKtr 

EN 1 



UP 




"i i nn i turrAmi 

COMMAND 



r T 


UF 

UP 




—VERTICAL VELOCITY 



FT/SEC 

FT/SEC 


C* iVr 

DTCMO— 

n c r m r\-~m 



^•AIRSPEED COWHAND 








— THROTTLE C OH “AND 




1000 LB5 
nee 



n t h ■ ■ ■ ■ 



““ELEVATOR COMMAND 




DEG 

« non i it 



P i 

n CU.M 



— ME A 5 UR FD THROTTLE 




1000 LBS 
nee 



p r r— - 
c • Apr— . 



—measured elevator 




DEG 

nee 



^ L ArL 



—PITCH RATF 
— NFSTED 0.05 1.07 
—NESTED 0.20 l.OZ 
—COUPLED 0.20 l.OZ 




Ut W 

DEG/SEC 



Trunct n 


1 






J C PUjL'J 









■ 

3 

A 

♦ 20.0ZC0T ♦ 

0. 

1 V**2 






(VALID FOP CAS • 
__ rni'Di cn n i n7 

120 TO 180 ONLY) 

a. 1 H ATAAT 







— LUl ritll U • C U UUc 
rrmoi cn ft n<? i at 







DM AX 

— 



— LDl'rLED 0.03 1 . 0 / 

— MAXIMUM change in 

HEIGHT ALLOWED 

BEFORE TRIPPOIHT 


FOR TRANSITION BETWEEN RNAV AND MLS 
FLAPON - .TRUE.— THF FLAP SCHEDULE IN THIS PROGRAM IS USED TO COMMA 
THF FLAPS 

• .FALSE.-FLAP COMPAND is INPUT 

7FILT • .TRUE*— THF 2 COMPLEMENTARY FILTER IN THIS PROGRAM IS USED 
- .FALSE. -THE AMA7 FILTER IS USED. DATA IS PASSED THROUGH 
AMAZ# AM A 70 

D2MAX2 MAXIMUM VALUE FOR ZDOT - FT/SFC 

NMULATI NUMBER OF 0.05 SEC PERIOD DELAYS BETWEEN RECEIVING 

MEASUREMENTS AND RELEASING CONTROL COMMANDS TO ACT 
IF PELT* • 20 AND NMULATI-1# DEL AY-REGUL AR 1 PERIOD 
DELAY 

IF PELT*. 20 AND NMULATI-2# DELAY-REGULAR 2 PERIOD 
DELAY 

IF DELT-.20 AND NMULATI-3, DEL AY-PEGUL AP 3 PERIOD 


DELAY 

IF DEL T* • 20 AND NMULATI**# DELAY-REGULAR * PERIOD 
DELAY 

IF DELT - .05 THEN NMULATI MUST • 1 

CASMAI MAXIMUM RATE OF CHANGE OF CAS COMMAND - FT/SEC 

DD7NA1 MAXIMUr RATE OF CHANGE OF ZDOT COMMAND - FT/SEC **2 

AP7EP1 PARAMETER IN' ZDOT - HIGH ALPHA REDUCTION - FT/SEC 

DEPUGO - .TRUE. — DEBUG PRINTOUT 


DIMENSION PGLOC 22) # GAINA<22> 


REAL KV# KTOFPS# LOCASN 


LOGICAL FIRST# 


FLAPON# ZFILT# ZALP# 


DEBUGO 


A 

I 

C 

E 

E 

E 

t 

E 

F 

G 


EQUIVALENCE IPGIOCI )» S311 )# 
<RGL0(3)#S313)# 
(PGLOtf )#S321 )# 

( PGLO ( 7 ) # S 323 ) # 
(PGLOCQ)#S325)# 
CPGLOCll ) #5377)# 
<PGlO(13)fS320)# 
( PGLOI 15) »S*11 ) t 
IPGL0<17)#5*13)> 
(PGLOf 19)#S*?1 )# 
( PGLO ( 21 ) # SA23 ) » 


< PGl 0 ( 2 ) # S31 2 ) # 
tPGL0(*)#S31A)# 

( PGL 0 ( M # S 322) # 

( PGL 0( fl) #S32A) # 
(PGLOnO)#S326)# 
(PGl 0( 1 2 ) # S32M )# 
t PGL 0 ( 1* ) # S321 0) # 
( PGLOI 16) #S*12)# 

( PGL 0( 1R )» S*1 A )# 
<PCLP(20)#SA22># 
fPCLO(22)#S*2A) 


DATA FIRST /.TRUE./ 


5 CONTINUE 


IF < .NOT. FIRST ) GO TO 10 
C INITIALIZE STATES 


IF f CAS .GT. 170 .AND. ICHOSLO .EO. * ) ICHOSLO • 3 


DELT - 0.2 

IF f ICHOSLO .EO. 
GKZ - 1. 

GKZD - 0.1 

GKV2 • 0.0 


.OR. ICHOSLO .EO. 6 ) DELT • 0.05 
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IF f ICHOSLO .EO. 3 .OP. ICHOSLO .FQ. A ) GKZO • 20. 
IP C ICHOSIO .GT. A ) GKZO ■ 10. 

IF I ICHOSLO .EO. 3 ) GKV2 • 0.1 

IF ( ICHOSLO .EO. A ) GKV2 • l.C 

CASZ • CAS 

IF < CASZ .LT. 120. ) C AS7 • 120. 

I F ( CASZ .FT. 300. ) CASZ » 300. 

CALL LONGSCHI CASZ* ICHOSLO* PGLO 1 


PPD 

• 

0.017A53293 

GRAY 

• 

32.17A 


R PD 

m 

0.017A532«25 

CECMAX 

9 

15. 


PITCH1 

• 

PITCHO 

PITCH 

C A S 1 

9 

CASO 

CAS*KTDFPS 

HDDFO 

9 

HDDF1 

ACC 

7PLUS 

9 

7M INUS 

7BAR0 

2DPLUS 


7DMINUS 

HVSI 

Z1 

• 

70 

-ZBAPO 

DZ1 

9 

DZO 

-HVSI 

DTI 

9 

DTO 

DTM 

DEI 

m 

DEO 

DEM 

VDT2 

m 

VDT1 

0.0 

VDE2 

9 

V0E1 

0.0 

7BIASP 

• 

7BIASM 

ACC 

C A$V° 1 

• 

CAS VP 0 

CASPKTOFMS 

ZALP 

» 

•FALSE. 


MULTI 

• 

DELT/T ♦ 

0.1 

IMULTI 

• 

MULTI - 

1 


IF C MULTI . EO. 1 ) NNULOTI ■ 1 
ACAS • EXP(-2.0*DELT) 

BC AS * 1.0-ACAS 
I TIME • 0 

ML OOP ■ 1.0/DELT ♦ 0.1 
CASMAX • CASMAl*DELT 
ODZMAX • 0DZMA1+DELT 
ADZ EP R - ADZEP1*DFLT 
ZDDMAX • 1.50 
AK1 - 0.6/ ( MULTI*MULT I ) 

AK2 • 2.0/ (MULTI ) 

HTOH ■ O.BO*T 

PHTOH - 0.320PT 

BTOH • -0.0095*T 

AKCMAX • 1.0 - FXP C-0. 5*PELT) 

AKCMIN . 1.0 - EXP(-0.025*DEITI 

A1 • { AKCHAX - AKCMIN ) /20.0 

A2 ■ AKCMIN 

GFEED • 1.0 - EXPf-2.0*DELT) 

C IN ITIALZE MODEL STATES 

ZM1 • -ZBAPO 

ZMD1 • -HVSI 

C INITIAL ZE INNER LOOP STATES 


HDOF - ACC 

CO • EXP (— 10.0*T ) 

XN ■ 0 

C A • EXP C-0.0625*T) 

C INITIALZE OTHER OATA 

ILOOP • -1 

C ASF ■ CAS 

DZMAX1 ■ D7NAX2 

FIRST - .FALSE. 

10 CONTINUE 

C CHECK FOR ICHOSLO - A PROBLEM 

IF « CAS .GT. 170 .AND. ICHOSLO .EQ, A ) FIRST • .TRUE. 

IF C FIRST ) GO TO 5 

C CHECK FOP LOOP ITERATION OF CONTROL LAV 
C PERFORM INNER LOOP CALCULATIONS 
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HDDF - C9MH0DF - ACC) ♦ ACC 

X N - CA * ( XN - 0) ♦ Q 

OF • 0 - XN 

RDLL2 ■ R0LLPP2 

C PERFORM Z COMPLEMENTARY FILTER 

ZPLUS • AMAZ 

7DPLUS • A* AZD 

IF( .NOT. 7FILT ) FO TO 15 

7FRR0P • 7BAP0 - ZMINUS 

ZPLUS » ZMINUS ♦ HTOH*ZERROR 

ZDPLUS ■ 7DMINUS + THTOH^ZERPOR 

7BIASP ■ ZBIASM ♦ BTOH*ZERROR 

C CORRECT ACCELORMETER FOR GRAVITY 

C**pp*AC ■ ACC 4 GRAV* (1.0 - C0S(PITCH*RPD)*C0$C8NK*RPDI) 

AC • ACC 

C CORRECT FOR BIAS 

AC • AC - ZBIASP 

C PROPAGATE 

ZDHINUS • 7DPLUS ♦ TPAC 

ZMINUS ■ ZPLUS ♦ T*ZDPLUS ♦ T*T*0.3*AC 

ZBIASM ■ ZBIASP 

13 CONTINUE 

IF ( INULTI .GE. MULTI ) IMULTI - 0 

IMULTI - IMULTI ♦ 1 

IF « IMULTI .NE. MULTI ) GO TO 70 

C BEGIN CONTROL LOOP 


C UPDATE CASVP 

CASFR ■ CASVP - CASVPO 

ACASC* ■ A1*ABS(CASER) + A2 

IF C ACASC .GE. AKCHAX ) AC ASG • AK CM AX 

DC A S ■ ACASG*CASER 

IF t ABSCDCAS) .GT. CASMAX ) DCAS • SIGN (1. 0# DC AS )*C ASM AX 
CASVPO • CASVPO ♦ DCAS 

C SCHEDULE FLAPC 

C ASF - ACAS *CA$ F ♦ BCAS*CA$ 

I F ( .NOT. FLAPON ) GO TO 20 
CASO • CASVPO/KTOOPS 
FLAPC - 0.0 

IF< CASO .LT. 190. G ) FLAPC - -0.25*CAS0 4 *7.3 

IF< CASO .IT. 170.0 ) FLAPC • -0.50*CASG 4 90.0 

JF( CASO .LT. 150.0 ) FLAPC - -1.00*CASQ ♦ 165.0 

!F< CASO .LT. 135.0 ) FLAPC - 30.0 

C COMPUTE FLIGHT PATH ANGLE 

20 CONTINUE 

GAMA - AS IN ( ZDPLUS/TAS ) /RPD 

C COMPUTE AOA TO COMPARE TO AOAMAX AND ADAHIN 

ALPHA • •ITCH - GAMA 
IF< alpha .LT. AOAMIN ) GO TO 35 
IF( .NOT, ZALP ) DZMAXl • DZMAX2/2.0 
7ALP * .TRUF. 

I F ( ALPHA ,GT. AOAMAX ) GO TO 30 
GO TD AO 

C REDUCE ZOOT COMMAND 
30 CONTINUE 


070 - ArZEPR*TAS*SIN( (AOAMIN - AIPHAXMD) 

MMaxI • DZMAXl 4 07D 

IP* DZMAXl .LT. 0.0 ) DZMAXl • 0.0 
62 • ACASPZM1 - BCAS’ZPIUS 

00 TO AO 



35 CONTINUE 

IF< DZMAX1 .LT. 0ZMAX2 ) DZMAX1 - OZMAX1 ♦ DDZHAX 
ZALP • .FALSE# 

AC CONTINUE 

OZNAX3 ■ AHAX1(CZHAX2#ABS(H0CVPM 
DZMAX • DZMAX3 

IF < 7 ALP JPZMAX - AM I HI < C ZMA XI, DZMAX3) 

C CHECK TO SEE IF GAIN UPDATE IS REQUIRED 

IF < I LOOP .GT. MLOOP ) ILOOP • -1 
ILOO* • ILOOP ♦ 1 
IF C ILOOP .NE. 0 ) GO TO 50 
CASZ ■ C ASF 

IF f CASZ .LT. 120.0 ) CAS7 - 120.0 
IF ( CASZ . GT • 300.0 ) CASZ - 300.0 

C CALCULATE THE LON GAINS 

CALL LONGSCH ( CASZ/ ICHOSLO, CAINA » 

50 CONTINUE 


C PROPAGATE MODEL 

ZMO ■ ZM1 

ZMDO - 7MD1 

07 AAA - HOCWP 

AHPA • 1.0 

I F ( ZALP > AMPA • 0.0 

IF C ZALP ) 07AAA ■ SIGN ( 1. /HOCWP )*D7NAX 

UN • AMPA*AK1*C-HCVP - ZMO) 4 AK2*(— D7AAA - ZMDO) 

ZDD - UN 

AMP - 1.0 

IF C U**ZMDO .LT. 0.0 ) AMP « 2.5 

IF C A9S (ZOO) .GT. UMP*ZDDMAX) ) ZDD ■ SIGN(1./ZDD)*ZC0NAX*ANP 


7MD1 - ZMDO 4 DELT+ZDD 

DZPP? • A m AX1(ABS(0ZAAA)/DZHAX) 

IF t ABSI7MD1) .GE. D7BP* .AMD. ABS(HDCVP) .LT. 0.1 ) 

A ZM01 ■ SIGN(1.,ZNP0)*DZBBB 

7DD ■ (ZMD1 - Z MDO/OELT 

IF C ABSCZDD) .GT. (A"P47CPMAX> J ZDO ■ S IGN ( 1 Z DO J *ZODMAX* ANP 
ZM01 • ZMDO ♦ DELTPZOD 

ZM1 ■ ZMO 4 DELT*ZMDO 4 DELT*PELT*Z0D*.5 
C COMPUTE CONTROL LAW STATE FEEDBACK 


A • CASO - CAS1 

B - PITCHO - PITCH1 

C • HPDFO - HDDF1 

0 • 70 - Z1 - (ZH1 - ZMO) 

E ■ OZO - DZl 


C COMPUTE INTEGRATOR 


F ■ GKZMZ1-7M0) 4 GKZP* (PZ1-ZMD0) 4 GKV2M0.5* 

A (C AS1*CAS1 - CASWP1*CASWP1)/GRAV) 

G ■ CAS1 - CASWP1 


C EASTON CONTROL GAINS 


PO 60 I-l#2? 

PGLOil) ■ PGLO(I) 4 6FEED* (GAINA ( I ) - PGIOIIM 
60 CONTINUE 


H • ZM01 - ZMOO 

P • CASWPO - CASWP1 

C DETERMINE IF THERF HAS BEEN A LARGE CHANGE IN 7 CAUSED BY CHANCING 
C RN A V TO ML 5 OP A BAD DATA POINT HAS OCCURRED 

IF ( AB S f P ) .LT. TMAX ) GO TO 65 
FIRST » .TRUE. 

GO TO 5 

65 CONTINUE 

C COMPUTE CONTROL LAV 
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VDTX • $3IX*VDT2 4 S3X3*VDE2 4 

1 S32I *A 4 S 323*B 4 S325*C 

2 S327*D 4 $329*E 4 

3 S4X X * F 4 S4X3*G 4 

4 S421*H 4 S423*P 

VDE1 • S312*VDT2 4 $3X4*VDE2 4 

1 S322* A 4 S324*B 4 S326+C 

2 5320*0 4 $32X0*E 4 

3 S4X2*F 4 $4X4*G 4 

* S422*H 4 $424*P 


0T0 ■ PTI 4 DELT*VDT1 

OEO • DEI 4 0ELT*V0E1 

IF( I LOOP .NE. 0 I GO TO 70 

C PRINT OUTPUT FOR DEBUG 

IF C •NOT. DEBUGO ) GO TO 70 

IF< NTIHE .EQ. ITIME ) VRITE(6#XOOO) (I, PGIO(I)# I-X#22) 
WRITE (6#2000> CASO* CASVPO* HCVP# ZMX# HOCWP# 

A ZMD1* 7PLUS# ZDPLUS# OEX 

WRITE (6* 3000 ) ZALP* AMPA, DZAAA, DZR BB* HOC VP* ZMDX, ZHDO#AHP#E#D 

70 CONTINUE 

IF ( IMUITI .NE* NNULOTI I GO TO 80 
C DOWNLOAD DATA 


PITCHI 

• 

PITCHO 

PTTCHO 

• 

PITCH 

CAS1 

■ 

CASO 

CASO 

m 

CAS*KTOF PS 

HDDF1 

9 

HDDFO 

HDOFO 

9 

HDDF 

ZX 

• 

zo 

zo 

9 

-ZPLU5 

0Z1 * 

a 

DZO 

DZO 

9 

-ZDPLUS 

CASWPX 

9 

CASWPO 

ATIME 

9 

ITIME/XOO 

ntime 

9 

ATIME*X00 


C PROCESS CONTROL COMMAND FOP CONTROL UNITS 
80 CONTINUE 

C LOVER LIMIT ON THROTTLE 

LOCAS" • 0*2* (222.0 - CAS) 

C UPPER LIMIT ON THROTTLE 

C RELATIONSHIP BETWEEN THROTTLE AND EPR AT E PR • X.e5# THPOTMA X - 42. 

£ EPR • 1.2# 7 HROTMA X • 60.0 

C IF CAS ERROR IS TOO LARGE INCREASE THROTMAX USING ADHICAS 

ADHICAS - ABS(G) - 8,0 

!F( G *Gt . -6.0 ) ADHICAS • 0.0 

HICASM - -2 7* 69*F PR 4 93.2265 4 ADHICAS 

IF( H I C A 5 * .GI. 6G.0 ) HICASM - 60.0 

IF< HICASM .IT. 42.0 ) HICASM ■ 42.0 

I F ( LOCASM .IT. 0.0 ) LOCASM ■ 0.0 

I F ( LOCASM .GT.1C.0 ) LOCASM ■ 10. 0 

IP C PTO , GT . HICASM ) VDTX ■ 0.0 

IF( OTO .GT, HICASM ) DTO ■ HICASM 

IF ( PTO .LT. LOCASM ) VDTX ■ 0.0 

IF ( DTO .IT. LOCASM ) DTO ■ LOCASM 

VDT2 • VOTX 

DTI • DTO 

DTCND • DTO 

C COMPUTE INNFR LOOP FOR ELEVATOR 

Y ■ HDDF 4 2 • X6*0F - 0.004*ROLL2 

DECMD « K V* (DEO 4 Y) 

IF( ABS(DECMP) .LT. DECMAY ) GO TO 90 
64 DEC MO • SIGN(X.0#DECMD)*DECMAX 

PEO - (DECMD/KV) - Y 

VDEX • 0.0 



<?o continue 

V0E2 • V0E1 

DEI • DEO 

ITINE • ITINE ♦ 1 

C FORMAT STATEMENTS 

1000 F0RN*T(lX,/#lX,6<I3,FI5.P) # /,iy,MI3,Fl3.a># 

A OlX>MI3>FS3.E)»/f 1 Xi6II3»F13.B|| 

2000 FORMAT (IX# "CASO CASWPO HCWP ZM1 HDCWP •# 

N A M2f»FJ0.A),/,1X, 

A "ZMDl ZPLl'S 7DPLUS DEI •» 

A Z ( ?X » F } 0 *4 ) ) 

3000 FORMAT ( IX f "741P AMPA DZ AAA 0IB8B HOCWP •# 

A I 1,4(2*, F10.M,/, IX, 

A -7MP1, 7MD0, AMP, E, 0 «, 

A M2X,F10'3J) 

RETURN 

END 


65 



REFERENCES 


1. Halyo, N. and Broussard, J. R. : "A Convergent Algorithm for the 

Stochastic Limited State Feedback Optimal Control Problem”, 1981 
Joint Automatic Control Conference, Charlottesville, VA, June 1981. 

2. Roskam, J. : Airplane Flight Dynamics and Automatic Flight Controls , 

Parts I and II, Second Edition, Roskam Aviation Engineering Corp., 
Lawrence, KS, 1979. 

3. White, W. F. , compiler: "Flight Demonstrations of Curved, Descend- 

ing Approaches and Automatic Landings Using Time Reference Scanning 
Beam Guidance." NASA TM-78745, 1978. 

4. Broussard, J. R. : "Design, Implementation and Flight Testing of PIF 

Autopilots for General Aviation Aircarft", NASA CR-3709, July 1983. 

5. Downing, D. R. , Bryant, W. H. and Ostroff, A. J. : "Flight Test of a 

VTOL Digital Autoland System Along Complex Trajectories", Proc. of 
the 1979 AIAA Guidance and Control Conference, Boulder, CO, August 
1979. 

6. Halyo, N. : "Development of a Digital Guidance and Control Law for 

Steep Approach Automatic Landings Using Modern Control Techniques", 
NASA CR-3074 , February 1979. 

7. Broussard, J. R. and O'Brien, M. J.: "Feedforward Control to Track 

the Output of a Forced Model", IEEE Trans. Auto. Control , Vol. AC-25, 
August 1980, pp. 851-852. 

8. Maybeck, P. S.: Stochastic Models, Estimation and Control , Vol. 3, 

Academic Press, New York, NY, 1982. 

9. Pines, S.: "Terminal Area Automatic Navigation, Guidance, and Control 

Research Using the Microwave Landing System (MLS) Part 2 - RNAV/MLS 
Transition Problems for Aircraft", NASA CR-3511, January 1982. 

10. Doyle, J. C. and Stein, G. : "Multivariable Feedback Design: Concepts 

for a Classical Modern Synthesis", IEEE Trans. Auto. Control , Vol. 
AC-26, February 1981, pp. 4-16. 

11. Broussard, J. R. and Stallman, S. T. : "Modification and Verification 

of an ACSL Simulation of the ATOPS B-737 Research Aircraft", NASA 
CR-166049 , February 1983. 

12. Broussard, J. R. : "ATOPS B-737 Inner-Loop Control System Linear 

Model Construction and Verification", NASA CR-166055, February 1983. 


66 



13. 


‘f 

Broussard, J. R. and Glasson, D. P.: "Optimal Multirate Flight Control 

System Design", 1980 Joint Automatic Control Conference, San Francisco, 
CA, August 1980. 

14. Broussard, J. R. and Halyo, N. : "Active Flutter Suppression Using 

Optimal Output Feedback Digital Controllers”, NASA CR-165939, May 1982. 

15. Etkin, B. : Dynamics of Atmospheric Flight , John Wiley & Sons, Inc., 

New York, NY, 1972. 

16. Miller, G. K. : "A Decoupled Control System for Improved Flight Per- 

formance in Wind Shear”, 1981 Joint Automatic Control Conference, 
Charlottesville, VA, June 1981. 

17. Dieudonne, J. E. : "Comments on a Proposed Standard Wind Hazard Environ- 

ment and Its Use in Real Time Aircraft Simulation", AIAA 17th Aerospace 
Science Meeting, New Orleans, LA, January 1979, AIAA paper 79-0324. 

18. Barrett, M. F.: "Conservatism with Robustness Tests for Linear Feed- 

back Control Systems", Proc. of the 19th Conference on Decision and 
Control, Albuquerque, NM, December 1980. 

19. Mukhopadhyay , V. and Newsom, J. R. : "Application of Matrix Singular 
Value Properties for Evaluating Gain and Phase Margins of Multiloop 
Systems", Proc. of the AIAA Guidance and Control Conference, San Diego, 
CA, August 1982. 

20. Safonov, M. G. : Stability and Robustness of Multivariable Feedback 

Systems , MIT Press, Cambridge, MA, 1980. 

21. Ostroff, A. J., Hueschen, R. M. , Hellbaum, R. F. and Creedon, J. F. : 
"Flight Evaluation of a Simple Total Energy-Rate System with Potential 
Wind-Shear Application", NASA TP-1854, May 1981. 


67 



LIST OF SYMBOLS 


In general, matrices are represented by capital letters and vectors 
are underscored; exceptions to these rules are only made when they are 
contradicted by standard aerodynamic notation. 


VARIABLE 

A 

a 

B 

b 

C 

c 

D 

E 

e 

e_ 

f_ 

G (s) 

g 

H 

h 


DESCRIPTION 

Discrete time feedforward matrix 
Fundamental matrix (continuous-time system) 

Acceleration 

Roll to rudder crossfeed gain 
Inverse of gain schedule time constant 

Component of the vehicle acceleration 
normal to the local level plane 

Control effect matrix (continuous-time system) 

Bias estimate 

Control law feedback gains 
Cross track error 
Control observation matrix 

Disturbance effect matrix (continuous-time system) 
2.71828 ... 

Vector error 

Vector-valued nonlinear function 
Plant transfer function 

Magnitude of gravitational acceleration vector 

Command observation matrix 

Euler angle transformation form 
Frame 1 axes to Frame 2 axes 
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Distance from the aircraft’s eg to the Earth’s 
surface, positive down 



VARIABLE 


DESCRIPTION 


I 

i 

J 

j 

K 

K(s) 

k 

^u» ^v> 

a 

M 


m 


N 

n 

P 

P 

A 

Q 

q 

q 

R 

“l 

r 

S 


s 


Identity matrix 
Index integer 
Cost functional matrix 
v^T 

Gain value 

Control transfer function 
Index integer 
Scales of turbulence 
Number of commands 

Cross weighting matrix in Linear Quadratic 
Regulator cost function 

Mass of the vehicle 
Number of controls 
Meters 

Number of time steps 
Number of states 

Riccati matrix in the optimal limited state 
feedback regulator problem 

Rotational rate about the body x-axis 

State weighting matrix 

Rotational rate about the body y-axis 

2 

Free stream dynamic pressure (=^pV ) 

Control weighting matrix 

Distance-to-go to an end of segment 

Rotational rate about the body z-axis 

Covariance matrix in the optimal limited state 
feedback regulator problem 

Laplace transform variable 
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VARIABLE 


DESCRIPTION 


T 



t 

u 

u 

V 


V 

W 

w 

w 

X 

o 

X 

X. 

y 

z 


Thrust 

Time-to-go to an end of segment 
Time 

Body x-axis velocity component 
Control vector 
Velocity magnitude 

Measurement noise covariance matrix 

Body y-axis velocity component 
Control difference 

Process noise covariance matrix 

Body z-axis velocity component 

White noise Gaussian vector 

Covariance matrix of state initial conditions 
Position along the x-axis 
State vector 

Position along the y-axis 
Position along the z-axis 


VARIABLE 

(GREEK) 

a 

3 


DESCRIPTION 

Wind-body pitch Euler Angle (angle of attack) 

Negative of wind-body yaw Euler angle (sideslip 
angle) 


Discrete time control effect matrix 


y Inertial-velocity axis pitch Euler angle 

(flight-path angle) 

6 Delta function 

latitude 

6, Aileron deflection 

A 
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VARIABLE 

(GREEK) 



n 

0 

X 


V 

5 

P 

z 

a 


DESCRIPTION 

Aileron command 

Aileron state 

Elevator deflection 

Elevator command 

Elevator state 

Flap deflection 

Rudder deflection 

Rudder command 

Rudder state 

Left spoiler deflection 

Right spoiler deflection 

Spoiler state 

Throttle deflection 

Throttle command 

Damping ratio 
Track angle error 

Gaussian noise 

Inertial-body pitch Euler angle 

Eigenvalue 

Longitude 

Measurement Gaussian noise 
Integrator state 
Air density 
Summation 

Real part of an eigenvalue in radians/ 
Standard deviation 
Singular value 



VARIABLE 

(GREEK) 

$ 

4 > 

< 1 * 

03 


DESCRIPTION 

Discrete-time system matrix 

Inertial-body axis roll Euler angle 

Inertial-body axis yaw Euler angle 

Frequency in radians/sec 
Imaginary part of an eigenvalue 


SUBSCRIPTS 

B 

b 

C 

CL 

E 

e 

f 

GS 

g 

H 

IL 

i 

j 

k 

m 

o 

s 


t 


DESCRIPTION 

Body axis 
Bias 

Command value 
Closed-loop 
Earth- relative axis 
Error quantity 
Full state feedback 
Ground speed 
Gust 

Horizontal 

Inner-loop 

Element index for vectors and matrices 

Element index for vectors and matrices 

Sampling instant index 

Model variable 

Nominal value 

Static pressure 
Stochastic 

Transient 
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SUBSCRIPTS 


DESCRIPTION 


u 

v 

w 

X 

y 

z 


Velocity component along body x-axis 
Velocity component along body y-axis 
Velocity component along body z-axis 
Horizontal perpendicular to y and z 
Horizontal perpendicular to x and z 
Vertical perpendicular to x and y 


SUPERSCRIPTS 

E 

T 

-1 


DESCRIPTION 
Earth (inertial) axis 
Transpose of matrix 
Inverse of matrix 


PUNCTUATION 

n 

o 

o 

3 ( )/ 3 ( ) 

E{ } 

V 

A ( ) 

( )* 

C) 


DESCRIPTION 

Derivative of quantity with respect to time 
Combined variable 
Vector quantity 

Partial derivative of one variable with 
respect to another 

Expected value 

For all 

Perturbation variable 
Star trajectory 
Estimated quantity 

Discrete cost function weighting matrix 

Infinity 

Integral 

Difference between variable and star trajectory 


I 

n 
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ACRONYM 

CORRESPONDING PHRASE 

ATOPS 

Advanced Transport Operating Systems 

CAS 

Calibrated Airspeed 

DIALS 

Digital Integrated Automatic Landing System 

DOF 

Degrees of Freedom 

dB 

Decibels 

EPR 

Engine Pressure Ratio 

IL 

Inner- loop 

kt 

Knot 

lim 

Limit 

lb 

Pound 

LQR 

Linear Quadratic Regulator 

MAX 

Maximum 

MEAS 

Measurement 

MLS 

Microwave Landing System 

MIN 

Minimum 

MXEPR 

Maximum Engine Pressure Ratio 

NASA 

National Aeronautics and Space Administration 

PIF 

Proportional Integral Filter 

rad 

Radians 

RNAV 

Area Navigation 

sec 

Seconds 

SIGN 

The positive or negative sign 

SPL 

Left Spoiler 

SPR 

Right Spoiler 

TAS 

True Airspeed 

tr 

Trace 

WO 

Wash-out 



TABLE 1. SCALES AND VARIANCE FOR GUST MODELS 



TABLE 2. COMMAND MODEL PARAMETERS 


LONGITUDINAL MODEL OPERATING AT 20 sps 

k h 

0.6 sec ^ 

k i 

2.0 sec”* 

k CAS 

Min (0.00 11 7205* (|CAS c -CAS m |) + 0.001249, 0.02469) 

h MAX 

If h *h < 0.0 THEN ti* „ = 1.14 m/sec^ (3.75 ft/sec^) 
m m MAX 


OTHERWISE K max = 0.457 m/sec 2 (1.5 ft/sec 2 ) 

cAs max 

0.76 m/s (2.5 ft/sec) 


LATERAL MODEL OPERATING AT 20 sps 

k 

G 

0.0984 deg/sec/m (0.03 deg/sec ft) 

k c 

3.77 m _1 (1.15 ft _1 ) 

‘Wx 

4.0 deg/sec 

^MAXl 

25.0 deg (ROLLMAX in Appendix B) 

^MAX3 

30.0 deg (ROLLMAK in Appendix B) 
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TABLE 3. SENSOR PARAMETERS 


Sensor 

Noise standard 
deviation 

Bias 

Comments 

Attitude gyro 

0.23 deg 

0.23 deg 


Rate gyro 

0.02 deg/sec 

0. 


Body mounted 
accelerometers 

1% of g 

1% of g 

0.2, -0.2, 0.25 deg misalign- 
ment and 0.25% scaling error 
modeled 

MLS-azimuth 

0.01 deg 

0.01 deg 


MLS-elevation 

0.01 deg 

0.01 deg 


MLS-DME 

2.3 m 

2.3 m 


Barometric altimeter 

0.91 m 

12.2 m 


Airspeed indicator 

1 m/sec 

1.5 m/s 


EPR measurement 

0.01 

0.02 

Used for limit check 

6. measurement 
A 

0.1 deg 

0.2 deg 

Used to initialize u. 

— k 

6_ measurement 
R 

0.1 deg 

0.15 deg 

t! 

6^ measurement 1 

0.2 deg 

0.4 deg 

11 

6 measurement 
E 

0.1 deg 

0.2 deg 

II 
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TABLE 4. SQUARE ROOT OF MATRIX DIAGONAL FOR 
LONGITUDINAL CONTROL SYSTEMS 


UNITS 

Q 

X 

o 

R 

Au (m/s) 

1.22 

0.61 


Aw (m/s) 

1.52 

1.52 


Aq (deg/sec) 

0.0 

1.0 


A0 (deg) 

65.0 

2.0 


Az (m) 

0.244 

3.05 


A6 e (deg) 

0.0 

0.0 


AEPR 

0.0 

0.0 


Aa h (m/s 2 ) 

0.0 

0.0 


Aq (deg) 

0.0 

0.0 


Au e (deg) 

0.0 

7.0 


Au t (deg) 

6.0 

4.0 


A C Z 1 " 

0.2 LON1 

1.0 L0N1 


ASz2 - 

0.2 LON2 

1.0 LON 2 


^?z3 

0.2 LON 3 

1.0 L0N3 


A ?CAS1 " 

0.2 LON1 

4.0 LON1 


A ?CAS2 ~ 

0.2 LON 2 

4.0 LON 2 


A ?CAS3 “ 

0.2 LON 3 

4.0 LON 3 


Ah (m) 

0.0 

0.0 


An (m/s) 

0.0 

0.0 


A^jg (m/s) 

0.0 

0.0 


Awg.On/s) 

Aw g2 _ 

0.0 

0.0 

0.0 

0.0 


Av e (deg /sec) 



9.0 

Av t (deg/sec) 

1 

... i 

12.0 




TABLE 5. SQUARE ROOT OF MATRIX DIAGONAL 
FOR LATERAL CONTROL SYSTEMS 


UNITS 

Q 

Xo 

R 

Av (m/s) 

30.5 

0.61 


Ap (deg/ sec) 

0.0 

0.0 


Ar (deg/sec) 

0.0 

0.0 


A<j> (deg) 

70. 0 

2.0 


A? (deg) 

0.0 

2.0 


Ac (m) 

1.5 

3.05 


AS a (deg) 

0.0 

1.32 


A6 r (deg) 

0.0 

0.5 


Ap (deg/sec) 

0.0 

0.0 


Ar WO (deg/sec) 

0.0 

0.0 


Ar (deg/sec) 

0.0 

0.0 


Au a (deg) 

0.1 

4. 


Au r (deg) 

0.2 

2. 


A5 C 1 " 

1.5 LAT1 

0.1 LAT1 


A£ c 2 - 

1.5 LAT2 

0.1 LAT2 


AC r i - 

0.8 LAT1 

0.1 LAT1 


AC r2 - 

0.8 LAT2 

0.1 LAT2 


Av„i (m/s) 

0.0 

0.0 


^82- 

0.0 

0.0 


Av a (deg/sec) 



30 

Av r (deg/sec) 
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TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES 


LON1 CLOSED-LOOP EIGENVALUES : AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
20 sps 

SCHEDULED 
20 sps 

A6 e 

-23.4 

-23.8 

-23.8 

Aa h 

- 6.93 

- 6.1 

- 6.1 

SHORT PERIOD 

- 2.1 ±j2. 8 

- 2.2 ±j2.5 

- 2.1 ±j2.5 

Au e ~Az 

0.0 ±j0.0 

- 0.68 ±j0 . 67 

- 1.26 

COMP. FILTER 

- 0.40 ±j0. 40 

- 0.40 ±j0.40 

- 0.40 ±j0 .40 

AEPR 

- 0.50 

- 0.81 

- 0.64 

Aut 

0.0 

- 0.30 

- 0.78 

PHUGOID 

- 0.0004±j0.067 

- 0.074±j0. 11 

- 0.20 ±j0.04 

A ^hl 

0.0 

- 0.064±j0.025 

- 0.048±j0.10 

Aq wo 

- 0.060 

- 0.060 

- 0.064 

a ^casi 

1 

0.0 

1 

- 0.034 


TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONTINUED) 


LON1 CLOSED- LOOP EIGENVALUES AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
5 sps 

SCHEDULED 
5 sps 

A6 e 

-23.4 

-20.0 

-20.3 

ASh 

- 6.93 

- 4.4 

- 4.4 

SHORT PERIOD 

- 2.1 ± j 2.8 

- 2.6 ±j2.9 

- 2.6 ±j2 .8 

Au e -Az 

- 0.0 ±j0.0 

- 0.71 ±j0.69 

- 0.78 ±j0.59 

COMP. FILTER 

- 0.40 ±j0.40 

- 0.40 ±j0 . 40 

- 0.40 ±j0.40 

AEPR 

- 0.50 

- 0.88 

- 0.83 

Auj- 

0.0 

- 0.31 

- 0.25 

PHUGOID 

- 0.0004±j0.067 

- 0.060±j0. 10 

- 0.17 

A fhi 

0.0 

- 0.065±j0.02 

- 0.035±j0.077 

A $wo 

- 0.060 

- 0.059 

- 0.064 

A ^CAS1 

0.0 

— 

- 0.032 
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TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONTINUED) 


LON2 CLOSED-LOOP EIGENVALUES AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
20 sps 

SCHEDULED 
20 sps 

A6 e 

-23.4 

-23.9 

-23.9 

Aa h 

- 6.93 

- 6.0 

- 5.0 

SHORT PERIOD 

-2.1 ± j 2 . 8 

- 2.3 ±j 2. 5 

- 2.3 ±j2.6 

Au e -Az 

0.0 ±j0.0 

- 0.87±j0. 42 

- 0.85±j0.17 

COMP. FILTER 

- 0.40 ±j0 . 40 

- 0.40±j0.40 

- 0 . 40±j0. 40 

aepr 

- 0.50 

- 0.68 

— 

Au t 

0.0 

- 0.20 

- 0 . 41± jO . 24 

PHUGOID 

- 0.004±j0 .067 

- 0 . 14±j0. 055 

- 0. 18±j0.038 

A^ h2 

AC W0 

s CAS2 

0.0 

- 0.075 

- 0.046 

- 0.060 

- 0.065 

- 0.065 

0.0 

- 0.033 

- 0.026 


TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONTINUED) 


L0N2 CLOSED-LOOP EIGENVALUES AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
5 sps 

SCHEDULED 
5 sps 

A6 e 

-23.4 

-20.3 

-20.3 

Aah 

- 6:93 

- 4.2 

- 4.3 

SHORT PERIOD 

- 2.1 ±j2. 8 

- 2.6 ±j2. 7 

- 2.6 ± j 2.7 

Au e -Az 

0.0 ±j0.0 

- 0.91±j0.43 

- 0. 86±j0 .48 

COMP. FILTER 

- 0.40 ±j0.40 

- 0.40±j0.40 

- 0.40±j0.40 

AEPR 

- 0.50 

- 0.68 

- 0.70 

Au t 

0.0 

- 0.19 

- 0.19 

PHUGOID 

- 0. 004±j0. 067 

- 0. 14±j0 . 057 

- 0. 14±j0.06 

A£h2 

0.0 

- 0.074 

- 0.076 

A 9W0 

- 0.060 

- 0.065 

- 0.064 

A ^CAS2 

0.0 

- 0.033 

- 0.034 
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TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONTINUED) 


LON 3 CLOSED-LOOP EIGENVALUES AT 77 m/2 (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
5 sps 

SCHEDULED 
5 sps 

A6 e 

-23.4 

-20.4 

-20.3 

Aa h 

- 6.93 

- 4.1 

- 4.2 

SHORT PERIOD 

- 2.1 ±j2. 8 

- 2.8 ± j 2 . 8 

- 2.8 ±j2.8 

Au -Az 
6 

0.0 ±j0.0 

- 0.82±j0.60 

- 0. 79±j0. 61 

COMP. FILTER 

- 0.40 ±j0 .40 

- 0.40±j0.40 

- 0.40±j0.40 

AEPR 

- 0.50 

- 0.72 

- 0.72 

A u t 

0.0 

- 0.24 

- 0.23 

PHUGOID 

- 0.0004±j0.067 

- 0.20,-0.13 

- 0.21,-0.13 


0.0 

- 0.051 

- 0.051 

A /vl1 J 

AC W0 

s CAS3 

- 0.06 

- 0.063 

- 0.063 

0.0 

- 0.032 

- 0.032 


TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONTINUED) 


LAT1 CLOSED-LOOP EIGENVALUES AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
20 sps 

SCHEDULED 
20 sps 

AS a 

-33.0 

-33.0 

-33.0 

A6 r 

-21.1 

-22.1 

-22.1 

Ar-Ap 

- 6.8 ± j 2.3 

- 6.9 ±j2.6 

- 6.9 ±j2.5 

u r 

0.0 

- 3.9 

- 3.9 

ROLL MODE-Ar wo 

- 2.7 ±j0. 91 

- 2.4 ±j0.84 

- 2.3 ±j 0. 92 

DUTCH ROLL 

- 0. 53±j0. 42 

- 0.58 ±j0.82 

- 0.61 ±j0.68 

<f>-u a 

0.0 ±j0.0 

- 0.41 ±j0. 30 

- 0.44 ±j0. 30 

C - ? r l 

0.0 ±j0.0 

- 0.16 ±j0. 21 

- 0.17 ±j0. 23 

c -^cl 

0.0 ±j0.0 

- 0.088±j0.084 

- 0. 085±j 0. 084 
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TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONTINUED) 


LAT1 CLOSED-LOOP EIGENVALUES AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
5 sps 

SCHEDULED 
5 sps 

AS r 

-33.0 

-30.5 

-31.2 

A6 a 

-22.1 

-22.2 

-22.0 

Ar-Ap 

- 6.8 ±j2. 3 

- 6.8 ±j3.1 

- 6.9 ±j3.1 

u r 

0.0 

- 4.6 

- 4.6 

ROLL MODE-A? wq 

- 2.7 ±j0. 91 

- 2.4 ±j0. 87 

- 2.4 ±j0. 95 

DUTCH ROLL 

- 0. 53±j0. 42 

- 0.58 ±j 0. 83 

- 0.58 ±j 0. 67 

4>- u a 

0.0 ±j0.0 

- 0.38 ±j0. 28 

- 0.41 ±j0.22 

C-5rl 

0.0 ±j0.0 

- 0.17 ±j0. 18 

- 0.19 ±j 0. 20 

c-? c l 

0.0 ±j0.0 

- 0. 095±j 0. 086 

- 0. 095±j 0. 08 


TABLE 6. CLOSED-LOOP MAPPED EIGENVALUES (CONCLUDED) 


LAT2 CLOSED-LOOP EIGENVALUES AT 77 m/s (150 kt) 


MODE 

INNER-LOOP 

OPTIMAL 
5 sps 

SCHEDULED 
5 sps 

A6 r 

-33.0 

-30.8 


-31.0 


A6 a 

-22.1 

-22.0 


-22.0 


Ar-Ap 

- 6.8 ±j2. 3 

- 6.9 

±j3.1 

- 6.9 

±j3.1 

u r 

0.0 

- 4.6 


- 4.6 


ROLL MODE-Ar 
DUTCH ROLL W0 

- 2.7 ±j0. 91 

- 2.5 

±0.84 

- 2.4 

±j0.9 

- 0. 53±j 0. 42 

- 0.58 

±0.82 

- 0.62 

±j0.73 

4>~ u a 

0.0 ±j0. 0 

- 0.37 

±0.30 

- 0.36 

±j0. 30 

C“5 r 2 

0.0 ±j 0. 0 

- 0.17 

±0.20 

- 0.19 

±j0.21 

c “?c2 

0.0 ±j0. 0 

- 0.10 

±0.12 

- 0.095±j0.12 
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TABLE 7. SAMPLE OF CLOSED-LOOP EIGENVALUE VARIATIONS WITH AIRSPEED 


VELOCITY 

(m/s) 

SHORT 

PERIOD 

PHUGOID 

CONTROL SYSTEM 

62 

-1.7 -jl.9 

-0.009 ±j0.087 


69 

-1.9 ±j2.6 

-0.004 ±j0.082 


77 

-2.1 ±j2.8 

-0.0004±j0.067 


85 

-2.1 ± j 3.2 

-0.0006±j0.062 

INNER-LOOP 

93 

-1.7 ±j 3. 9 

0.018 ±j0. 049 


124 

-1.2 ±j5.3 

0.024 ±j0. 026 


139 

-1.0 ±j5 . 6 

0.030 ±j0. 013 


154 

-0.95±j5. 7 

0.029 ±j0. 012 


62 

-1.06±jl.4 

-0.26 ±j0.10 


69 

-2.5 ±j2.3 

-0.23 ±j0.018 


77 

-2.6 ±j 2. 8 

-0.25, -0.17 


85 

-2.4 ±j 3. 3 

-0.26, -0.14 

LON1 5 sps 

93 

-1.9 ±j3.9 

-0.28, -0. 052+j0 .04 

SCHEDULED 

124 

-1.2 ±j5. 2 

-0.36, -0 . 045+j0 .035 


139 

-1.0 ±j5. 5 

-0.42, -0.041+j0.042 


154 

-1.0 ±j5.5 

-0.50, -0.045+j0.041 


62 

-1.1 ±jl.8 

-0.15 ±j0.09 


69 

-2.6 ±j2. 3 

-0.14 ±j0.06 


77 

-2.6 ±j2. 7 

-0.14 ±j0.06 


85 

-2.5 ±j 3. 2 

-0.14 ±j0.02 

LON2 5 sps 

93 

-1.7 ±j4.0 

-0.25 ±j0.03 

SCHEDULED 

124 

-1.0 ±j5. 3 

-0.33, -0.04 +j0. 012 


139 

-0.84±j5.5 

-0.32, -0.04 +j0. 026 


154 

-0. 81±j5. 6 

-0.30, -0.04 +j 0.026 


62 

-1.0 ±jl. 3 

-0.19 ±j0. 072 


69 

-2.7 ± j 2.3 

-0.18 ±j0. 008 


77 

-2.8 ±j2.8 

-0.21, -0.13 


85 

-2.6 ±j3. 3 

-0.23, -0.09 

L0N3 5 sps 

93 

-1.7 ±j4.0 

-0.27, -0.046+j0.014 

SCHEDULED 

124 

-1.03±j5.3 

-0.33, -0.036+j 0.011 


139 

-0.88±j5.5 

-0.32, -0. 037+j0 .020 


154 

-0.84±j5.7 

-0.30, -0. 037+j0 . 020 
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TABLE 7. SAMPLE OF CLOSED-LOOP EIGENVALUE VARIATIONS WITH 
AIRSPEED (CONCLUDED) 


VELOCITY 

(m/s) 

DUTCH 

ROLL 

CROSS 

TRACK 

CONTROL SYSTEM 

62 

-0. 62±j0. 59 

0.0 ±j0.0 


69 

-0. 53±j0. 42 

»l 


77 

-0.57±j0.36 

ft 


85 

-0. 58± jO. 37 

tl 

INNER-LOOP 

93 

-0.59±j0.42 



124 

-0.60±j0.38 

ft 


139 

1 

o 

00 

l- 1 

o 

'vj 

o 

ft 


154 

-0.96,-0.62 

ft 


62 

-0. 59±jO. 97 

-0.19 ±j0. 21 


69 

-0. 56±j0. 87 

-0.17 ±j0. 18 


77 

-0. 59±j0. 78 

-0.18 ±j0. 17 


85 

-0.53±j0.81 

-0.15 ±j0 . 17 

LATl 5 sps 

93 

-0.64±j0.86 

-0.11 ±j0. 13 

OPTIMAL 

124 

-0. 71±j0. 86 

-0.11 ±j0. 15 


139 

-0. 69±j0. 75 

-0.093±j0. 14 


154 

-0. 66±j0. 75 

-0.080±j0.098 


62 

-0. 56±jl . 0 

-0.19 ±j0. 20 


69 

-0. 58±j0. 67 

-0.19 ±j0 . 20 


77 

-0. 57± jO. 79 

-0.17 ±j0. 17 


85 

-0.53±j0.85 

-0.15 ±j0. 16 

LATl 5 sps 

93 

-0.68±j0.89 

-0.16 ±j0 . 14 

SCHEDULED 

124 

-0.55±j0.81 

-0.090±j0. 15 


139 

-0. 68±j0. 74 

-0.090±j0.13 


154 

-0.77±j0.78 

-0.080±j0.11 
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TABLE 8. MINIMUM SINGULAR VALUES' FOR LON2, 5 sps, SCHEDULED GAINS 


VELOCITY 

(m/s) 

— 

FIRST MINIMUM 
SINGULAR VALUE 
(DB) 

— 

FREQUENCY 

(RAD/SEC) 

SECOND MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

62 

-3.6 

mam 

-3.2 

1.3 

69 

-3.0 


-3.1 

1.2 

77 

-3.0 

0.21 

-3.2 

1.1 

85 

-2.8 

0.19 

-3.2 

1.0 

93 

-1.9 

0.17 

-3.2 

0.91 

124 

-1.7 

0.16 

-3.4 

1.0 

139 

-1.9 

0. 16 

-3.5 

1.0 

154 

-1.8 

0.16 

-3.6 

1.0 


TABLE 9. MINIMUM SINGULAR VALUES FOR LON2 , 20 sps, SCHEDULED GAINS 


VELOCITY 
(m/ s) 

FIRST MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 
(RAD/ SEC) 

SECOND MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

61 

-3.2 

0.23 

-4.0 

1.0 

69 

-2.5 

0.21 

-3.8 

1.1 

77 

-2.5 

0.20 

-3.8 

1.1 

85 

-2.5 

0.19 

-4.0 

1.0 

92 

-1.8 

0.17 

-4.0 

1.0 

123 

-1.7 

0.17 

-4.0 

1.0 

138 

-1.9 

0.17 

-4.0 

1.0 

154 

-1.0 

0.17 

-4.0 

1.0 
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TABLE 10. MINIMUM SINGULAR VALUES FOR LAT1, SCHEDULED GAINS 



5 sps 

20 sps 

VELOCITY 

SINGULAR VALUE 

FREQUENCY 

SINGULAR VALUE 

FREQUENCY 

(m/s) 

(DB) 

(RAD/SEC) 

(DB) 

(RAD/SEC) 

62 

-12.3 

0.53 

-11.9 

0.48 

69 

-12.6 

0.58 

-12.3 

0.53 

77 

-17.3 

0.44 

- 17.2 

0.44 

85 

-17.2 

0.43 

-17.1 

0.44 

93 

-20.1 

0.40 

-20.1 

0.40 

124 

-23.2 

0.53 

-23.0 

0.44 

139 

-23.5 

0.48 

-23.5 

0.40 

154 

-25.9 

0.44 

-26.2 

0.36 


TABLE 11. MINIMUM SINGULAR VALUES FOR LON1, 5 sps, SCHEDULED GAINS 


VELOCITY 

(m/s) 

FIRST MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

SECOND MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

62 

-6.0 

0.08 

-3.4 


69 

-5.2 

0.08 

-3.2 


77 

-5.2 

0.09 

-3.2 

| ' 

85 

-4.7 

0.10 

-3.1 


93 

-2.4 

0.15 

-5.8 


124 

- 

- 

-7.3 


139 

- 

- 

-8.0 


154 

-2.6 

0.-15 

-8.2 

0.8 


86 









TABLE 12. MINIMUM SINGULAR VALUES FOR LON3, 5 sps, SCHEDULED GAINS 


VELOCITY 

(m/s) 

FIRST MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

SECOND MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

62 

-2.7 

BBB 

-3.1 

1.6 

69 

-2.7 


-3.1 

1.6 

77 

-2.9 

WEmm 

-2.6 

1.2 

85 

-2.7 

KS1H 

-2.6 

1.1 

93 

-1.8 

WSaSm 

-2.6 

1.0 

124 

-1.6 

CBS 

-2.8 

1.0 

139 

-1.8 

tifwillii 

-2.9 

1.0 

154 

-1.8 

mm 

-3.0 

1.1 


TABLE 13. MINIMUM SINGULAR VALUES FOR LAT1, 5 sps, SCHEDULED GAINS 


VELOCITY 

(m/s) 

MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

MINIMUM 
SINGULAR VALUE 
(DB) 

FREQUENCY 

(RAD/SEC) 

62 

-6.0 

1.1 

-3.3 

0.56 

69 

-6.0 

1.0 

-2.8 

0.58 

77 

-5.0 

1.0 

-3.5 

0.52 

85 

-5.0 

1.0 

-2.7 

0.58 

93 

-4.2 

1.2 

-3.3 

0.58 

124 

- 4.7 

1.0 

-3.3 

0.63 

139 

-4.4 

1.0 

-2.5 

0.58 

154 

-3.9 

1.0 

-2.2 

0.52 
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TABLE 14. LAT2 FREQUENCY DOMAIN PROPERTIES, 5 sps , SCHEDULED 

GAINS, A6 LOOP OPEN, AS LOOP CLOSED 
a r 


VELOCITY 

(m/s) 

MINIMUM 
SINGULAR 
VALUE (DB) 

FREQUENCY 

(RAD/SEC) 

FIRST GAIN 
MARGIN 
(DB) 

FREQUENCY 

(RAD/SEC) 

62 

-6.1 

1.1 

11.5 

0.25 

69 

-6.1 

1.0 

10.3 

0.25 

77 

-5.5 

1.0 

11.6 

0.23 

85 

-5.2 

1.0 

12.4 

0.23 

93 

-4.5 

1.2 

25.2 

0.22 

124 

-4.6 

1.2 

12.2 

0.25 

139 

-4.8 

1.2 

12.4 

0.25 

154 

-5.1 

1.1 

12.8 

0.27 


TABLE 14. LAT2 FREQUENCY DOMAIN PROPERTIES, 5 sps, SCHEDULED 

GAINS, AS LOOP OPEN, AS LOOP CLOSED (CONCLUDED) 
a r 


VELOCITY 

(m/s) 

PHASE 

MARGIN 

(DEG) 

FREQUENCY 

(RAD/SEC) 

SECOND GAIN 
MARGIN 
(DB) 

FREQUENCY 

(RAD/SEC) 

62 

38 

0.69 

-10.0 

1.8 

69 

36 

0.69 

- 9.5 

1.8 

77 

39 

0.63 

- 9.8 

i:6 

85 

40 

0.63 

-10.1 

1.7 

93 

49 

.65 

-10.2 

1.7 

124 

42 

.63 

-10.7 

1.7 

139 

41 

.61 

-11.5 

1.7 

154 

39 

.63 

-10.8 

1.7 
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TABLE 15. CURVED TRAJECTORY FLIGHT CONDITIONS 


WAYPOINT 

X 

(m) 

Y 

(m) 

z 

(m) 

RADIUS 

(m) 

A 

-6706.0 

2896.0 

-1406.0 

0 

B 

-6706.0 

- 107.0 

-1406.0 

2286.0 

C 

-7209.0 

-3048.0 

- 829.0 

2286.0 

D 

-4923.0 

-2743.0 

- 383.5 

0 

E 

-4923.0 

0.0 

- 256.8 

1524.0 

F 

1000.0 

0.0 

0.0 

0.0 

AIRCRAFT 





STARTING 

-6706.0 

1981.0 

-1406.0 

0 

POSITION 






WAYPOINT 

LATITUDE 

(DEG) 

LONGITUDE 

(DEG) 

SPEED 

(m/s) 

A 

38.01214601 

-75.44233621 

75.0 

B 

37.99775995 

-75.41336030 

75.0 

C 

37.98749129 

-75.38191319 

75.0 

D 

37.97157281 

-75.39875636 

75.0 

E 

37.98472385 

- 75.42522296 

69.5 

F 

37.9449551 

-75.45699678 

69.5 

AIRCRAFT 

1 



STARTING 

38.00776522 

-75.43350985 

69.5 

POSITION 






WEIGHT 

CG 

FLAPS 


85000.0 lbs 

0.2 

40 deg-FIXED 

AIRCRAFT 

PARAMETERS 

INITIAL 

HEADING 

INNER-LOOP 
SAMPLE RATE 

OUTER-LOOP 
SAMPLE RATE 


122.2 deg 

20 sps-ALWAYS 

VARIES IN 
FIGURES 






a) DESIGN CONFIGURATION 


CONTINUOUS-TIME PLANT 



b) IMPLEMENTATION CONFIGURATION 
20 or 5 sps 20 S P S 



FIGURE 1. INNER- LOOP, OUTER- LOOP CONTROL SYSTEM BLOCK DIAGRAMS 
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LONGITUDINAL ACCELERATION 
VCSDOT 








vO 

-E> 




INNER-LOOP CONTROL SYSTEM BLOCK DIAGRAM 















FIGURE 6. COMPARISON OF LON3 OPTIMAL AND GAIN SCHEDULED GAINS 



AIRCRAFT 



t 


DESIRED VERTICAL PATH 


FIGURE 7. ALTITUDE CAPTURE 
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CRS (M/S) , HEIGHT (M) CRS ( M/S) , HEIGHT (M) CRS ( M/S) HEIGHT (M) 









a) LONi 

O HOOT 




98 


FIGURE 8. ALTITUDE CAPTURE SIMULATION, 5 sps OUTER-LOOP (CONCLUDED) 



CRS ( M/S) HEIGHT ( K) CRS ( M/S) , HEIGHT (M) CRS ( M/S) , HEIGHT (M) 


a) L0N1 



0 26 52 78 10* 130 156 182 208 23* 260 


TIME (SEC) 


b) LON 2 
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O H/5 
□ HCMD - H 


iooL 


i*or 


j . i .l_ L i i \ — 1 i_i 


L_l— L-LJ— 1_-1— J— i— 1—1— Ll 1—1 L_l— LJ 1 L— 1— I 1 I — L l -j 
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26 


62 


Q- 

J00 - — 

6o r i i i 


78 inn 130 156 

Tjumseq 

-a G G— -;§r=>~ 0 G G G G G G- 


208 23* 260 

O CRS 
□ CRSCMD 


G 


jO" 


1 II I I I I I 1 I I I 1 I M 1 I 1 1 1 J I 1 I t l 1 1 I I I 1 -l.-i-J. 

10* 130 156 

TIME { SEC) 


26 


52 


78 


182 


208 


23* 


260 


100 


c) L0N3 


G G G G -o G *0 -o -0 -0 -o -O’ 


oh— 


^-G G- 

-ET 


^3 E3----0 q G 


-0 G G G 


O H/5 
□ HCMD - H 


loo t J 1 1 1 1 I 1 L 1 1 I 1 

0 26 62 78 



i i I i i i 1 i i 

10* 130 

TIME ( SEC) 

G -G -O G- 


156 

G* 


i i I i i i I i i 

182 208 


-0 -0 


o 

□ 


231 260 

CRS 

CRSCMD 


co l i i i I 
o ee 


1 i i i I i i i I i i i 1 i i i 1 i i i I i i i 1 i i ' -I i i -i I 

62 78 101 130 158 182 200 231 260 

TIME ( SEC) 


FIGURE 9. CAS CAPTURE SIMULATION, 5 sps OUTER-LOOP 
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LONG CONTROLS ( DEG) EPR THROTTLE/20 LONG CONTROLS ( DEG) EPR THROTTLE/20 LONG CONTROLS (DEG) EPR THROTTLE/20 

I I W * M ** “ 

! U 3 ' ■— _ •• 



•O— -O' ■'■o — "©■ 

■a, 

-□ •£)■ 


"G-~ 

— -o— 

--0-- 

- o— 

— o-- 

— o— 

-O-- 

— o- 

■-0— 

---0-- 



--a-- 

--a— 


■--o— 

---a-- 


□ FLfiP/S 





TIME ( SEC) 



TIMF ( SEO 


100 


FIGURE 9. CAS CAPTURE SIMULATION, 5 sps OUTER-LOOP (CONCLUDED) 




FIGURE 10. HORIZONTAL PATH CAPTURE 
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CRS i M/S) _ „ CAS (M/S) CRS( M/S) CPS (M/S) 


a) LON1 5 sps 


80 


70 



•a — S : ===§'^ 


soLl_i I I I I I I I 

0 25 SO 




-i__L 


ns 


O CAS 
□ CflSCMD 


J — > — I — l — I — l — l l I 

200 225 2S0 


b) L0N2 5 sps 



c) LON2 20 sps 


\ o ~J 


\ 


-i — i — i — I — i — i — i Ll_l_i 


LlAI 


i i i l i 


25 50 75 100 125 ISO 

TIME (SEC) 


O CflS 
□ CflSCMD 


J — i — i — i — I i i i I i i i 1 

nS 200 225 2Sn 


d) L0N3 5 sps 



FIGURE 13. WIND SHEAR SIMULATION (CONCLUDED) 


105 



EPR THROTTLE/20 ERR THRQTTLE/20 E pR THROTTLE/20 EPR THR0TTLE/20 


O EPR 

0 THROTTLE/20 


a) L0N1 5 sps 





TIME (SEC) 


d) LON 3 5 sps 



TIME (SEC) 


FIGURE 14. WIND SHEAR SIMULATION: THROTTLE RESPONSE 
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FIGURE 15. CONTROL SYSTEM BLOCK DIAGRAM FOR FREQUENCY 
DOMAIN EVALUATION 
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AMPLITUDE ( DB) AMPLITUDE ( D3) 


a) L0N2 






AMPLITUDE ( DB) AMPLITUDE ( DB) 



FREQUENCY ( RADS/SEC) 

FIGURE 19. L0N2 ELEVATOR LOOP FREQUENCY RESPONSE USING 

SCHEDULED GAINS, OUTER-LOOP SAMPLE RATE = 5 sps 



FREQUENCY ( RADS/SEC) 


FIGURE 20. LAT1 AILERON LOOP FREQUENCY RESPONSE USING 

SCHEDULED GAINS, OUTER- LOOP SAMPLE RATE = 5 sps 


no 


PHASE I DEG) PHASE ( DEG) 






Ill 


PHASE ( DEG) PHASE ( DEG) 





AMPLITUDE (DB) AMPLITUDE ( DB) 


■ a) THROTTLE LOOP OPEN, ELEVATOR LOOP CLOSED 



FREQUENCY ( KADS/SEC) 


b) ELEVATOR LOOP OPEN, THROTTLE LOOP CLOSED 



FREQUENCY (RADS/SEC) 


FIGURE 22. LON 2 BODE PLOTS USING OPTIMAL OUTPUT FEEDBACK GAINS 


112 


PHASE (DEG) PHASE 






LONG CONTROLS ( DEG) EPR THROTTLE/20 PITCH (DEG) HDOT ( M/S) CRS ( M/S) , HEIGHT ( M) 










LONG CONTROLS (DEG) EPR THROTTLE/20 PITCH ( DEG) HDOT (M/S) CRS (M/S) L HEIGHT ( M) 



O 25 50 75 100 125 ISO 175 200 225 250 



TIME (SEC! 


FIGURE 25. LON 2 CURVED TRAJECTORY PERFORMANCE, 5 sps 
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LONG CONTROLS ( DEG) EPR,- THROTTLE/20 pitch (DEG) HOOT (M/S) CRS (M/S) HEIGHT ( M) 














LflT CONTROLS (DEG) CRTE t ti) TRGi (DEG) SIDESLIP (DEG) ROLL (DEG) 










LONG CONTROLS (PEG) EPR THROTTLE/20 PITCH (DEG) HDOT ( M/S) CflS ( tt/S) HEIGHT (M) 



-O d-- — G G G G G-- ><e ,^ N 


70 


/■O' 
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o 25 50 75 100 125 150 175 200 225 250 
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TIME (SEC) 


FIGURE 29. LONl CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCES, 5 sps 
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FIGURE 30. LON2 CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCES, 5 sps 
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LONG CONTROLS ( DEG) EPR THROTTLE/20 PITCH (DEG) HOOT ( M/S) CRS ( M/S) HEIGHT ( M) 


100 


O H/S 
□ HOMO - H 



O HDOT 
□ HDOTCMD 



-n r, .n ^ „ T:ME (SEC) 
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FIGURE 31 . LON 3 CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCE, 5 sps 
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LONG CONTROLS l DEG) EPR THROTTLE/20 PITCH l DEG) HDOT t M/S) CRS t M/S) HEIGHT t M) 



0 25 50 7S 100 125 150 175 200 225 250 



0 25 50 75 100 125 150 175 200 225 250 



TIME (SCO 


FIGURE 32. L0N2 CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCES, 20 sps 
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LONG CONTROLS (DEG) E?R THROTTLE/20 PITCH (DEG) HDOT l M/S) CAS ( M/S) , HEIGHT (M) 


IOO 


0 25 SO 75 100 125 ISO 176 200 22S 250 

10[— „ TIME (SEC) „ „ 
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FIGURE 33. LON1 CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCES, 20 sps 
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FIGURE 34. LAT1 CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCES, 5 sps 
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FIGURE 35. LAT1 CURVED TRAJECTORY PERFORMANCE WITH DISTURBANCES, 20 sps 
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FIGURE 36 
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